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ABSTRACT.  The  purpose  of  this  tutorial  report  is  to  allow  the  reader 
with  a  United  background  in  optimum  estimation  techniques  and/or 
inertial  system  theory  to  achieve  a  level  of  competence  which  will 
permi*  his  participation  in  the  deaign  and  evaluation  of  aided 
inertial  guidance  systems.  To  this  end,  the  Kalman  Filter  is  described 
in  some  detail,  with  full  use  of  Intuitive  concepts.  Next,  the  theory 
of  Inertial  navigation  is  presented.  Based  on  an  understanding  of 
inertial  systems  and  the  Kalman  Filter,  the  reader  is  then  shown  how 
the  two  are  combined  to  provide  accurate,  aided  inertial  systems. 
Problems  arising  in  the  application  of  the  Kalman  Filter  to  practical 
situations  are  discussed  and  coasnon  methods  for  solving  them  are 
Illustrated.  Examples  in  inertial  navigation,  gyrocompass ing,  and 
alignment  transfer  are  provided  in  support  of  the  theoretical 
development. 
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FOREWORD 


■“Ili  ■  ifie  analysis,  synthesis,  and  design  nf  strapped-down  inertial 
^'ildanue  systems  at  the  Naval  Weapons  Center,  China  Lake,  Calif.,  It 
has  Income  evident  that  the  problem  of  alignment  and  initialization 
represents  an  area  of  great  concern.  Strapped-down  alignment  and 
initialization  has  been  expected  to  engender  problems  different  than 
gi&balled,  but  not  problems  whose  solutions  are  technically  unfeasible. 


As  an  aid  to  the  research  and  development  effort  for  strapped-down 
Inertial  guidance,  some  essential  groundwork  has  been  prepared  with  the 
procurement  of  this  tutorial  report  for  application  of  the  Kalman  filter 
techniques  for  aiding  inertial  systems. 


This  document  was  written  for  the  Naval  Weapons  Center  under 
Contract  N60530-67-C-1052 .  The  work  was  performed  by  Arthur  A. 
Sutherland,  Jr.  and  Arthur  Gelb ,  of  The  Analytic  Sciences  Corporation. 
Professor  Charles  £.  Hutchinson,  University  of  Massachusetts,  Department 
of  Electrical  Engineering,  consulted  during  the  program. 

The  work  was  performed  under  AirTask  A36533205/216-1/F009-03-03. 

Review  for  technical  accuracy  was  given  by  Luke  Crews  and 
William  F.  Bali,  Weapons  Development  Department,  and  by  Professor 
Neville  Retra,  Department  ot  Engineering,  University  of  California, 

Los  Angeles. 
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Rection  1  .  INTRODUCTION 


HISTORICAL  BACKGROUND 


Inertial  navigators  are  among  the  meat  precise  of  all  plertnwrhgfl- 
ical  device#.  Tlte  simple  theoretical  basis  of  Inertial  navigation  is  the 
measurement  of  linear  and  angular  motion  and  employment  of  Newton's  laws 
to  compute  changes  in  position,  velocity,  and  attitude.  Conceptually 
the  inertial  system  is  self-contained,  but  in  practical  use  Its  perform¬ 
ance  deteriorates  seriously  with  time  unless  external  indications  of  the 
navigation  quantities  are  used  to  remove  self-generated  errors.  Thus, 
it  can  b#  said  that  the  utility  of  the  inertial  system  lies  in  its  ability 
to  provide  information  between  external  measurements. 


Classically,  external  measurements  were  used  to  update  the  inertial 
system  variables  in  a  deterministic  manner,  i.e.,  system  position  indica¬ 
tion  was  changed  to  agree  with  the  resaltB  of  a  position  fix,  etc.  And, 
by  proper  employment  of  external  meas-’-ements ,  sensor  errors  were  removed 
from  the  system  calculations  (assuming  these  errors  to  be  constant) . 

This  approach  ignored  two  important  facts.  First,  external  measurements 
themselves  contain  random  errors  which  may  be  significant  compared  to 
the  inertial  system  errors.  Also,  the  system  errors  are  primarily  caused 
by  random,  time-varying  inertial  sensor  errors.  The  optimum  use  of 
external  measurements,  properly  accounting  for  measurement  errors  and 
sensor  errors,  has  therefore  become  an  important  source  of  improvement 
in  inertial  navigation  system  accuracy. 


Application  of  the  Kalmar  Filter  to  inertial  navigation  systems 
began  in  the  early  1960's,  shortly  after  optimum  recursive  filter  theory 
was  developed  and  published.  Because  the  errors  in  a  useful  inertial 
system  propagate  in  essentially  a  linear  manner  and  linear  combinations 
of  these  errors  can  be  detected  from  external  measurements,  the  Kalman 
Filter  is  ideally  suited  for  estimating  them.  Operationally,  the  filter 
relates  to  the  inertial  navigator  and  external  measurements  as  illustrated 
in  Fig.  1.  It  also  provides  useful  estimates  of  all  system  error  sources 
which  have  significant  correlation  tiroes.  Figure  2  demonstrates  two 
common  schemes  for  using  the  error  estimates  to  correct  lystem  errors. 


In  addition,  the  Kalman  Filter  provides  improved  design  and  opera¬ 
tional  flexibility.  As  a  time-varying  filter,  it  can  accommodate  non¬ 
stationary  error  sources  when  their  statistical  behavior  is  known. 
Configuration  changes  in  the  inertial  system  are  easily  treated  by  simple 
programming  changes.  The  Kalman  Filter  provides  for  optimum  use  of  any 
number,  combination,  and  sequence  of  external  measurements.  It  is  a 
technique  for  systematically  employing  all  available  external  measurements, 
regardless  of  their  errors,  to  improve  the  accuracy  of  inertial  naviga¬ 
tion  systems. 


ICeasuretneut 

Errors 


System  Disturbances 


FIG.  1.  Kalsan  Filter  Operation  in  Iuertial  Navigators. 


. . . II  q  mill  IVK"  uiii'UUll^ll  U" 


NVhj  TF  4652 


Error  Sources 


(a)  FeetMorward  Cojrfiguratlon 


System 

Error 

Sourcea 


Estimates  of 
System  Error 
Sources 


COMPUTER 


Intao  Filter 


Jeasurement 


Improved 

System 

Output 


Measurement 
_  Error 
Sources 


(b)  Feedback  Configuration 

FIG.  2.  Kalman  Filter  Systets  Goar igurs tions . 
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The  reader  Interested  in  Further  background  information  in  the  areas 
of  matrix  algebra  and  linear  system  theory  is  referred  to  Kel .  1. 


ILLUSTRATION  OF  THE  IMPROVEMENT  POSSIBLE 

A  few  figure*  serve  to  illustrate  the  ability  of  the  Kalman  Filter 
to  provide  superior  performance  in  inert  1«1  Figure  3  compares 

the  RMS  cruise  mode  agimuth  error  of  an  aircraft  inertial  navigation 
system  when  fixed-gain  velocity  damping  is  provided  (constant  gain  feed¬ 
back^  and  -when  -the  Kalman  Filter  {optimal  feedback)  i£  Used.  In  "boih 
cases  continuous  external  velocity  measurements  were  provided  and  external 
position  fixes  were  mad a  every  15  minutes.  The  fixed-gain  filter  did 
not  use  nosit. Ion  measurements  to  improve  its  knowledge  of  azimuth. 

However,  the  discontinuities  in  the  trace  indicate  that  the  Kalman  Filter 
was  able  to  infer  something  about  azimuth  error  each  time  a  new  position 
fix  became  available. 

Figure  4  demonstrates  the  ability  of  the  Kalman  Filter  to  determine 
inertial  sensor  errors.  It  represents  the  RMS  error  in  the  knowledge  of 
constant  gyro  drift  rates  In  an  aircraft  inertial  navigation  system,  start 
ing  with  a  1  deg/hr  uncertainty.  For  this  example  the  Kalman  Filter  Is 
operating  on  position  fixes  only.  The  dramatic  improvement  in  calibration 
of  gyro  error  suggests  a  considerable  increase  In  navigation  accuracy 
between  position  fixes. 

An  illustration  of  the  Kalman  Filter's  ability  to  decrease  alignment 
time  of  inertial  navigators  Is  provided  by  Fig.  5.  It  shows  the  RMS 
axlmuth  alignment  error  for  fixed-gain  and  Kalman  Filter  airborne  align* 
ment  modes  of  an  inertial  navigation  system.  Both  schemes  use  an  external 
indication  of  vehicle  velocity,  but  the  ability  of  the  Kalman  Filter  to 
also  .utilize  position  fixes  is  demonstrated .  It  is  evident  that  the 
optimal  use  of  information  provides  a  significant  reduction  in  the  time 
required  to  align  to  given  accuracy  or  reduces  errors  at  the  end  of  a 
given  alignment  period. 


OUTLINE  OF  SECTIONS 

Section  2  continues  with  a  discussion  of  the  basic  concepts  which 
characterize  the  Kalman  Filter.  These  include  state  space  notation, 
uncorrelated  random  processes,  the  Kalman  Filter  equations,  and  the 
estimation  error  covariance  matrix.  Section  3  follow  with  a  discussion 
of  inertial  navigation  systems.  Beginning  with  a  brief  description  of 
inertial  aensors,  it  progresses  through  glmballed  and  strapdown  inertial 
measurement  units  rn  the  equations  of  inertial  navigation  and  the 
linearized  expressions  for  inertial  navigation  errors. 
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Fixed  Gam  \ 
Optimal  With  Position 
Fixes  Every  15  Mm. 
Optimal  With  Position 
Fixes  Every  Min. 


FIG.  5.  Optimal  Versus  Conventional 
Airborne  Alignment  Accuracy  (Ref.  2). 


Section  4  describes  the  correlation  properties  of  errors  in  inerts 
sensors  and  external  measurements.  It  illustrates  the  steps  necessary 
h?r  err°rS  ln  thC  nianner  squired  by  the  Kalman  Filter. 
svsJena  Laaa!ri?e8  iraportant  ™chaniZations  of  inertial  navigati< 

to  them  WhfnVel°PLth?  expyefsloas  necessary  to  apply  Kalman  Filterinj 

navigation  system  errors  are  estimated 
they  are  applied  as  corrections  to  the  navigator.  Section  6  discusses 

«eali€M  ^  °Utput  t0  minimlze  inertial  navigator  erroi 

Se:^i0n,7  dfcscrit'8  th®  nee  of  the  Kalman  Filter  for 

*?Ction  8  the  transfer  alignment  of  one 

tE  /H  r  ,  anot*er-  Ptactical  considerations  which  arise  in 
se  of  the  Kalman  Filter  are  discussed  in  Section  9.  They  include 
ompu  er  requ_reoents,  observability  of  state  variables,  suboptimal 
titering  to  reduce  complexity,  and  sensitivity  analyses. 
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Section  2.  KALMAN  FILTER  CONCEPTS 


In  the  lace  1940's,  Herbert  Wiener  first  specified  the  linear  filter 
which  has  the  capability  of  separating  a  single  signal  from  additive 
noise,  minimizing  the  mean  square  error  in  the  indicated  signal— Filter 
output  or  estimate  (see  Ref.  4).  The  "Wiener  Filter"  is  time  invariant 
and  the  minimum  mean-squared  error  criterion,  is  theoretically  achieved 
only  after  the  stationary  signal  and  noise  have  been  operated  upon  for 
an  infinite  time. 

In  the  decade  that  followed  Wiener's  first  results,  his  theory  was 
extended  to  cover  the  cases  where  filtering  was  conducted  over  a  finite 
period,  the  filter  received  inputs  at  discrete  instants  of  time,  the 
filter  and  its  inputs  were  nonstationary,  and  several  signals  (states) 
were  to  be  detected.  In  the  early  1960's,  Kalman  and  others  (Ref.  5,  6, 
and  7)  provided  a  unified  body  of  linear  filter  theory  which  handles  all 
of  these  situations  and  is  expressed  entirely  in  the  time  domain.  The 
Kalman  Filter,  as  it  has  come  to  be  called,  provides  an  essentially  real¬ 
time  reduction  of  its  input  data  to  give  a  minimum  variance  (i.e.,  least 
squares)  estimate  of  the  state  variables  in  a  nonstationary  linear  system. 
It  can  be  derived  in  many  different  ways.  Under  identical  assumptions, 
the  following  approaches  all  yield  the  same  filter:  least  squares 
estimation,  Bayesian  estimation,  maximum  likelihood,  and  conditional 
expectation. 


LINEAR  DYNAMIC  SYSTEMS  1 

i 

The  Kaliuai'i  Filter  is  formulated  using  state  vector,  time  domain  f 

notation.  The  state  of  a  dynamic  system  is  any  complete  set  of  quantities  l 

necessary  to  describe  the  unforced  motion  of  that  system  at  all  future  j 

times.  Given  the  state  at  any  time  and  a  history  of  the  system  forcing 
functions,  the  state  at  any  subsequent  time  can  be  computed.  If  the  ! 

linear  system  behavior  is  described  by  an  order  linear  differential 
equation  in  the  dependent  variable,  driven  by  f(t),  a  function  of  the 
independent  variable,  t,  ! 


i 


A(n)(t)  +  •••  +  a  A(1)(t)  +  a  A(t)  »  f(c) 
2  1 


(1) 


! 


!  the  system  state  can  be  described  by  the  dependent  variable.  A,  and 

I  its  first  (n-1)  derivatives,  A  more  compact  formulation  is  introduced 

f  in  the  following  example. 

I 


f  ■ 


Egjjmgle;  The  linear  second-order  differential  equation  for 
the  variable  X  is  expressed  by 

*A  +  a  (t)  X  +  a  (t)  X  ■  a(t)  +  8(t) 
t  1 


where  the  time  functions  a  and  $  are  driving  the  equation. 
Any  number  of  driving  functions  are  possible  in  the  general 
case.  Appropriate  state  variables  can  be  defined  as 

x  -  X 

1 

x  -  A 

2 

Then 

•  i 
X  -  X  m  x 
1  2 

x  -  X  ••  -a  (t)  x  -  a  (t)  x  +  ct(t)  +  3(c) 

2  2  2  1  1 


In  vector-matrix  form,  the  equation  is 


which  1b  a  first-order  vector  differential  equation.  This 
compact  formulation  can  be  generalized  to  an  nth  order  system. 


The  state  variables  of  a  linear  aystem,  x  ,  •••  x  ,  are  written  in 

X  XI 

the  form  of  a  state  vector  for  ease  in  manipulation 


The  state  variables  of  any  nc  order  continuous  linear  system  can  be 
defined  in  such  a  manner  that  the  system  dynamics  are  expressed  in  the 
form  of  a  first-order  linear  differential  equation  in  the  state  vector  x. 


8 


The  vector  notation  permits  the  equation  to  be  written  in  a  compact 
vector-matrix  form 

x(t)  -  F(t)  *(t)  +  G(t)  y(t)  (2) 

The  vector  u  contains  the  independent  variables  that  are  forcing  the 
system  differential  equations.  If  x  has  n  elements  and  u  has  r  elements, 
F  and  G  are  u  x  n  and  n  x  r  matrices,  respectively.  Figure  6  is  a  block 
diagram  illustration  of  Eq.  2. 


System 


FIG.  6.  Block  Diagram  of  First-Order  Linear  Differential 
Equations  in  State  Space  Notation. 


Given  the  state  at  time  tQ,  denoted  x(tQ) ,  and  the  vector  forcing 

function  u(t)  for  all  time  greater  than  t^,  the  state  at  any  subsequent 

time,  t,  can  be  found  by  solving  the  state  differential  equation,  Eq.  2- 
Another,  frequently  more  useful,  way  to  express  the  state  vector  behavior 
uses  the  state  transition  matrix,  denoted  $  (t,  t^)  to  describe  the  effect 

of  the  state  at  t  on  the  state  at  some  other  time,  t.  The  transition 
n 

matrix  is  an  influence  function.  In  the  absence  of  forcing  terms,  the 
influence  of  x(t  )  on  )c(t)  is  displayed  through  the  relation 


x(t)  -  $(1,^) 


(3) 
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The  state  transition  matrix  is  computed  from  the  system  dynamics  as 
expressed  in  the  system  matrix.  F,  When  P  is  a  constant,  t  is  a  function 
of  the  time  difference  (t-tQ)  and  is  given  by 

${t-t  )  -  eF(t“£n)  (4) 

n 


The  matrix  exponential  in  Eq.  4  Is  a  legitimate  operation  and  can  be 
expressed,  by  analogy  with  the  scalar  exponential,  as 

vi*  +  \  <t-t  )* 

eF(t-V  -  i  +  (t-t*)  F  +  —fl—  F2  +  ... 

00 

-  L 

j-0 


(t 


j  t 


(5) 


where  I  is  the  n  x  n  identity  matrix.  When  F  is  time-varying,  the  state 
transition  matrix  must  be  calculated  from  the  differential  equation 

d[*(t,t  )] 

- dt- -  F(t)  *(t,tn)  ;  *(tn,tn)  -  l  (6) 

Further  details  on  computing  $  are  available  in  Ref.  8. 

-  When  F  is  time-varying  and  forcing  terms  are  available,  the  state 

vector  can  be  expressed  In  terms  of  x(tn)  and  the  state  transition  matrix 
by 


x(t)  -  *(t,t  )  x(t  )  +  /  *(t,T)  G(T)  u(t)  dT 
-  n  n  J  — 


where 


df  [*T(t,  T)]  -  -  FT(t)  *T(t,  T)  ;  *(t,t)  -  I 


(7) 


If  interest  la  focused  on  the  system  state  vector  only  at  discrete  points 
in  time,  Eq.  7  can  be  expressed  as  a  difference  equation 


^n+l 


+  w 


(8) 


I 


# 

| 


I 


I 
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where  the  notation  Xj,  indicates  the  state  vector  at  tn,  Unless  the  gygtem 
dynamics  are  stationary  (not  time-varying)  and  the  time  interval  is  fixed, 
$n  will  be  a  function  of  time  and  of  the  interval  between  the  instants 
represented  by  ta  and  tn+^ .  The  term  Wj,  represents  the  effect  of  the 
forcing  function  u  over  the  interval  tn  to  t^j. 


w  « 

— n 


t)  G(t)  u(t)  dt 


(9) 


The  expression  given  in  Eq.  8  will  be  used  extensively  in  the  discussion 
which  follows. 


STATE  ESTIMATION  WITHOUT  MEASUREMENTS 

In  the  absence  of  random  forcing  terms,  the  system  state  behaves  in 
a  deterministic  (directly  calculable)  manner  described  by  Eq.  7.  However, 
when  random  disturbances  are  present,  the  system  exhibits  random  behavior 
and,  if  exact  measurement  of  x(t)  is  not  always  possible,  it  becomes 
necessary  to  estimate  the  state  vector.  If  an  estimate  Is  provided  at 
some  point  in  time,  tn,  and  the  system  is  not  observed  (i.e.,  no  measure¬ 
ments  of  the  stcte  are  available),  the  best  estimate  of  the  state  at  all 
subsequent  times  is  provided  by  solving  the  deterministic  portions  of 
Eq.  8.  The  estimate  at  tn  is  used  as  the  initial  condition.  Two  factors 
contribute  to  errors  in  the  estimate  at  times  later  than  tn;  the  errors 
in  the  initial  estimate  propagate  in  a  manner  described  by  $  and  random 
uncertainties  in  knowledge  of  the  forcing  functions  provide  additional 
errors. 

Thus  far  we  have  dealt  with  deterministic  quantities.  By  definition, 
random  processes  cannot  be  specified  quantitatively  as  functions  of  ti^a. 
It  is  necessary  to  describe  then  in  a  statistical  manner.  In  particular, 
it  is  sufficient  to  describe  random  quantities  (assumed  Gaussian)  by 
their  first  and  second  moments  in  order  to  apply  the  Kalman  Filter. 

The  first  statistical  moment,  or  mean,  is  described  and  removed  from 
consideration  by  specifying  it  to  be  zero.  Any  quantity  which  is  biased 
by  a  known  amount  can  be  replaced  by  a  zerc-mean  variable  through  simple 
redefinition.  The  second  statistical  moments  between  processes  are 
described  in  the  state  vector  notation  by  the  covariance  matrix. 
Convariance  matrices  are  discussed  in  Appendix  A.  Conceptually  their 
diagonal  elements  are  measures  of  the  "size"  of  the  random  signals  they 
describe,  while  the  off-diagonal  elements  provide  a  treasure  of  the 
interrelation  between  different  random  processes.  It  is  assumed  through¬ 
out  this  discussion  that  covariances  between  random  quantities  are  zero 
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if  not  explicitly  stated  to  be  otherwise.  Because  enseable  averages  or 
expectations  are  takes  is  defining  the  covariances,  the  results  of  the 
calculations  are  a  valid  representation  only  of  the  ensemble  average 
behavior  of  the  filter  and  its  estimates , 

The  estimate  of  the  state  at  tn  is  designated  by  Kg  and  the  random 
error  in  that  estiaata  is  defined  by 


The  covariance  matrix  of  ijj  is  denoted  by  Pn.  For  zero-mean  variables, 

•  E  (*»  4  )*  <u> 

If  Qjj  is  the  covariance  matrix  for  the  random  portion  of  w^,  a  difference 
equation  can  be  obtained  from  Eq.  8,  10,  and  11  which  describes  the  growth 
of  the  estimation  error  covariance 

P  '  ,  -  $  P  *T  +  Q  (12) 

n+1  n  n  n  Hn  v  ' 

In  arriving  at  Eq.  12,  use  is  made  of  the  fact  that 

E  (4  »J)  -  0  (13) 

since  Wjj  is  uncorrelated  in  time. 

It  can  be  seen  that  the  random  uncertainties  in  (described  by  Qn) 
can  only  Increase  the  errors  in  the  estimate  of  the  system  state  as 
described  by  P;  this  is  a  reasonable  conclusion.  Mathematically  it  results 
from  the  fact  that  %  is  «  non-negative  definite  matrix.  In  continuous 
notation  a  differential  equation  for  the  error  covariance  matrix  results 
(see  Appendix  A) 


P  -  FP  +  PFT  +  GQGT  (14) 

where  Q  is  the  covariance  matrix  for  the  random  portion  of  u. 

It  should  be  noted  that  the  random  quantities  forcing  the  system 
can  take  two  very  distinct  forms.  One  Is  errors  in  the  control  applied 
to  the  system.  The  other  represents  random  disturbance  of  the  system. 


Throughout  the  report  the  symbol  f  preceding  a  vector  product  is 
used  to  denote  the  ensemble  average  of  the  quantity  enclosed  in  the 
brackets. 


12 


Brit,  if  -ra.-Z. 


When  a  known  control  or  forcing  function,  £<t),  is  used  in  the  presence 
of  system  disturbances,  Eq .  2  can  be  written  as 


i(t)  »  F(t)  Jt(t)  +  G(t)  u/t)  +  L(t)  £(t)  <15) 


to  demonstrate  the  separate  effects.  Then,  when  the  two  effects  ere 
uncorralatcd,  Eq.  12  and  14  can  be  written  as 


n+1 


$  P 

n  n 


r  +  q  +  s 

n  n 


(16) 


and 


P  =  FP  +  PFT  +  GQGT  +  LSLT 


(17) 


Here  the  S  matrices  are  the  covariance  of  the  errors  in  anpllcation  of 
the  control,  while  the  Q  matrices  describe  the  effect  of  the  random 
disturbances.  Since  the  two  random  driving  functions  have  analogous 
effects  on  the  error  covariance,  only  random  system  disturbances  will  be 
considered  in  the  subsequent  discussions. 


KALMAN  FILTER 

When  use  is  made  of  measurements  to  change  the  estimate  of  x,  the 
error  in  the  estimate  is  also  changed.  Hopefully  this  error,  or  rather 
the  statistical  description  of  it,  is  in  some  way  reduced.  In  the  Kalman 
Filter  the  measurements  are  taken  as  linear  combinations  of  the  system 
state  variables,  corrupted  by  uncorrelated  noise.  The  measurement 
equation  Is  written  in  vector-matrix  notation 

z  “  H  x  +  v  (18) 

-n  n  — n  — n  ' 


where  z  is  the  set  of  measurements  at  time  t  ,  z,  ,  .... 
-n  n  1  * 

in  vector  form 


V 


arranged 


(19) 
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ILp,  is  a  tj  jc  n  matrix  describing  tb#  linear  comb las t Iona  of  state  variables 
which  comprise  la  the  absence  of  noise.  Also,  Vg  is  a  vector  of  random 
noise  quantities  corrupting  the  measurements . 

Example;  Suppose  It  is  desired  to  estimate  the  constant 
scalar  quantity  x  baaed  on  a  noise-corrupted  Beasureneats, 

_ His  notes  has  aara  mean  and  i®  ®B&orrel®i«d .  As  uaMssed, 

minimum  variance  estimate  results  when  £  la  taken  as  the 
average  of  the  measurements ,  r^, 

n 

*<*>  -;E', 

1-1 

When  an  additional  measurement  becomes  available, 

trU 

*  rrr  2  *i 

1-1 

However,  the  estimate  based  on  n  +  1  measurements  can  be 
computed  employing  only  x(n)  and  the  (n  +  l)st  measurement 

□ 

£(n+1)  "  TTT  £  +  Vi 

i-i 


n  +  1 


1 

n  +  1 


-  £<n)  +^~T  “  i(n>J 


The  new  estimate  Is  the  old  estimate  modified  by  a  weighted 
difference  between  the  old  estimate  and  the  most  recent 
measurement.  This  is  a  recursive  formulation,  eliminating 
the  need  to  store  past  measurements. 

3y  analogy  with  the  example,  one  logical  way  to  use  the  measurement 
vector  Xj,  is  to  anticipate  It  based  on  knowledge  of  the  measurement 
matrix  Hq  and  the  estimate  of  the  state  vector  at  the  Instant  the  measure¬ 
ments  are  taken.  If  Cq  and  Hq  £q  do  not  agree,  the  difference  must  result 
from  the  measurement  noise  v„  or  an  error  In  the  estimate.  The  state 
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variable  estimates  can  then  br  changed  according  to  statistical  knowledge 
of  the  errors  in  5^  and  of  the  measurement  errors.  It  would  be 
appropriate  to  cause  the  state  vector  estimate  after  consideration 

of  the  measurement,  to  be  related  to  xjj(-)  by 


i  (+)  “  S  (-)  +  K  [s 

n  .  .  — n  n  ^5 


H  K  (-)] 
n  — n 


Between  measurements,  the  state  vector  estimate  will  obey  the  deterministic 
part  of  Eq.  8.  This  behavior  of  x  is  illustrated  in  Fig.  7.  It  can  be 
seen  that  the  state  estimate  between  measurements  is  obtained  by  math- 
ematical  modeling  of  the  system. 

The  use  of  measurements  provided  at  discrete  instants  of  time  causes 
the  error  covariance  to  be  discontinuous,  having  different  values  before 
and  after  the  measurements.  This  is  Illustrated  in  Fig.  2,  3,  and  4. 

For  this  reason,  the  error  covariance  matrix  immediately  before  the 
measurements  taken  at  the  nc^  instant  are  used  1b  designated  Pn(-). 

The  same  matrix  after  the  measurements  are  employed  is  called  PT(+). 

The  matrix  Pn(-)  is  computed  according  to  Eq.  12 

?_,(-)  -  ♦  P  (+)  4?  +  Q  (21) 

n+i  n  n  n  n 


If  Eq.  20  is  used  to  improve  the  state  vector  estimate,  the  new  error 
covariance  is  expressed  (see  Appendix  B)  by 

P  (+)  ■  { I  -  K  H  )  P  (-)  (I  -  K  H  f  +  K  R  KT  (22 

n  \  nn/n\  un/  nnn 


where  I  is  the  square  identity  matrix  and  is  the  covariance  matrix 
of  the  measurement  errors  Vjj. 

The  Kalman  Filter  was  originally  derived  under  assumptions  that 
permit  the  a  priori  specification  of  a  linear  structure  (Ref.  9). 

The  optimum  filter  waB  found  to  have  the  structure  shown  in  Fig.  7. 

That  is,  it  processes  the  measurements  sequentially  according  to  Eq.  20. 
Tn  addition,  it  estimates  between  measurements  according  to  Eq.  3  and 
the  filter  gain  matrix  is  specified  by 

K  -  P  (+)  H*  r"1  (23) 

a  n  n  n 


"■nrrnCTM  llimHilPvlufllllimiliriBIWBWWRllIBMIlJnGI 
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An  alternate  form  of  Re .  23  which  can  avoid  the  LoneequenrpB  nf  a 
singular  P.  matrix  ia 


SC  •  f>  (-)  »IT  H  P  <-)  HT  4  R  }~X 
u  n  n  n  n  n  nj 


(24) 


"(See  AppendixB. )  Substitution  of  Eq,  23  nr  2.U  into  2?  -provides  an 

-expression  Tor  the  new  error  covariance  matrix  entirely  in  terms  of  the 

measurement  matrix  H  and  the  measurement  error  covariance 
n 

P  (+)  s  P(-)  -  p(-)  H*  [h  P  (-)  +  R  l'1  HP  (-)  (25) 

n  n  n  nlnn  nnJ  nn 

■  (i  -  K  H  )  P  (-) 

\  n  nf  n 

Using  Ko .  21  and  25,  the  error  covariance  can  be  calculated  for  any 
measurement  time.  Equation  23  or  Eq .  24  then  provides  the  filter  gain 
matrix  and  F.q .  20  updates  x.  The  state  vector  estimate  Ib  carried 
forward  to  the  next  measurement  bv  Ea .  3.  The  optimum  estimation 
procedure  is  illustrated  in  Fig.  8. 

The  continuous  version  of  the  Kalman  Filter  is  illustrated  in  Fig.  9. 
The  measurements  are  described  by 


z(t)  =  H(t)  x(t)  +  v(t) 


(26) 


Measurements  are  employed  to  change  the  derivative  of  the  state  vector 
estimate  according  to  t’ne  equation 


x  =  F  £  +  k(z  -  H  x) 


(27 , 


The  Kalman  FilLer  gain  matrix  is  specified  by 


T  -1 

K  «  P  H  R 


(28) 


and  the  differential  equation  for  the  error  covariance  is 
P  =  FP  +  PFT  -  PHT  R-1  HP  +  GOGT 


(29) 


Inspection  of  Eq.  21,  25,  and  29  and  the  knowledge  that  Q,  R  and  the 
initial  error  covariance  are  all  symmetric  matrices  reveals  that  P,  Pn(+), 
Pu(-)  are  always  symmetric.  Steady-state  values  of  the  error  covariance 
(and  thus  the  filter  gain)  can  be  calculated  for  many  stationary  systems 
with  stationary  noises  without  specification  of  the  initial  value 
of  P  (Ref.  5). 
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FIG..  8.  Infc.wation  Flow  Diagram  for  Discrete  Kalman  Filter 


•Kl 


FIG.  9.  B.’.ock  Diagran  of  the  Continuous  Estimation  Equations 


Intuitive  Concepts 

Inspection  of  the  equations  describing  the  behavior  of  the  error 
covariance  matrix  reveals  several  observations  which  confirm  our  intuition 
abqut  the  filter  operation.  The  effect  of  system  disturbances  on  the 
growth  of  the  error  covariance  can  be  seen  from  Eq,  2l  and  29  to  be  the 
same  as  that  observed  when  measurements  were  not  available  (Eq .  12  and  14) . 
The  larger  the  statistical  parameters  of  the  disturbances  as  reflected 
in  the  "size"  of  the  0  matrix  and  the  more  pronounced  the  effect  of  the 
disturbances  as  reflected  in  the  "size"  of  the  G  matrix,  the  more  rapidly 
the  error  covariance  will  grow. 

The  effect  of  measurement  noise  on  the  error  covariance  of  the  dis¬ 
crete  filter  is  observed  better  in  an  alternate  form  of  Eq.  25  (Ref.  10) 

P"1  ('/  -  P'1  (-)  +  H*  R"1  H  (30) 

n  n  n  n  n 

Large  measurement  noise  (RJ^)  provides  only  a  small  increase  in  the 
inverse  of  the  error  covariance  (a  small  decrease  in  the  error  covariance) 
when  the  measurement  is  used;  the  associated  measurements  contribute 
little  to  reduction  in  estimation  errors.  On  the  other  hand,  small 
measurement  errors  (large  R^1)  cause  the.  error  covariance  to  decrease 
considerably  whenever  a  measurement  is  utilized.  When  measurement  noise 
is  absent,  Eq.  25  must  be  used  because  R^l  does  not  exist. 

The  effect  of  measurement  noise  on  the  ability  of  the  continuous 
Kalman  Filter  to  provide  accurate  estimates  of  the  state  appears  in  the 
third  term  on  the  right  side  of  Eq.  29.  If  noise  occurs  in  every  element 
of  the  measurement,  K  and  R  are  positive  definite  matrices.  The  term 

PHT  R_1  HP  (31) 

is  also  positive  definite  and  the  negative  of  this  will  always  cause  a 
decrease  in  the  "size"  of  a  non-zero  error  covariance  matrix  P.  The. 
magnitude  of  this  term  is  inversely  proportional  to  statistical  parameters 
of  the  measurement  noise.  Larger  measurement  noise  will  cause  the  error 
covariance  to  diminish  less  rapidly  or  to  grow,  depending  on  the  system 
dynamics,  disturbances,  and  the  initial  value  of  P.  Smaller  noise  will 
cause  the  filter  estimates  to  converge  on  the  true  values  more  rapidly. 

In  the  absence  of  measurement  noise  in  any  of  the  elements  of  zt  R-1  does 
not  exist.  This  case  is  treated  in  Ref.  6.  The  effects  of  system 
disturbances  and  measurement  noises  of  different  magnitudes  can  be 
described  graphically  by  considering  the  standard  deviation  of  the  error 
in  the  estimate  of  representative  state  variable.  This  is  presented  in 
Fig.  10  for  a  hypothetical  system. 
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FIG.  10.  Behavior  of  the  RMS  Error  in  the  Kalman 
Filter  Estimate  of  a  Particular  State  Variable. 


Fquations  21,  25,  and  29  are  similar  to  difference  and  differential 
equations  that  appear  frequently  in  optimization  problems.  Some  work 
has  been  accomplished  which  demonstrates  that  the  ♦  (or  F),  G,  and  H 
me trices  say  be  manipulated  in  order  to  minimize  certain  elements  of  the 
error  covariance  matrix  (Ref .  11  and  12).  This  provides  a  complementary 
improvement  of  the  Kalman  Filter. 


Kalman  Filter  Gain  Matrix 


It  was  pointed  out  earlier  that  the  optimality  of  the  Kalman  optimal 
linear  filter  is  contained  in  the  structure  of  the  filter  as  displayed 
in  Fig.  7  and  9  and  in  the  specification  of  the  gain  matrices  by  Eq.  23 
or  24  and  28.  There  is  an  intuitive  logic  behind  the  Kalman  Filter  equa¬ 
tions  for  the  gain  matrix.  It  can  be  seen  from  Eq.  23 


K 


n 


V+>  "l 


but  the  same  ideas  apply  to  Eq.  28.  In  order  to  better  observe  the  mean¬ 
ing  of  the  relation,  assume  that  Hn  is  the  identity  matrix.  It  is  simply 
the  transformation  matrix  relating  the  ideal  measurements  to  the  system 
state  according  to  Eq.  18.  When  Hn  Is  the  Identity  matrix,  both  Pn(+)  and 
are  n  x  n  matrices.  If  is  a  diagonal  matrix  (no  cross-correlation 
between  noise  terms) ,  results  from  multiplying  each  column  of  the  error 
covariance  matrix  by  the  appropriate  Inverse  of  mean  square  measurement 
noise.  Each  element  of  the  filter  gain  matrix  is  essentially  the  ratio 
between  statistical  measures  of  the  uncertainty  in  the  state  estimate 
and  the  uncertainty,  in  a  measurement.  If  measurement  noise  1«  large  and 
state  estiiute  errors  are  small,  the  quantity  _z  in  Fig  7  and  9  is  due 
chiefly  to  the  noise  and  only  small  changes  In  the  state  estimates  should 
be  made.  On  the  other  hand,  small  measurement  noise  and  large  uncertainty 
in  the  state  estimates  suggest  that  i  contains  considerable  Information 
about  errors  in  the  estimates.  Therefore  the  difference  between  the 
actual  measurement  and  that  predicted  from  Hx  will  be  used  as  the  basis 
for  strong  corrections  to  the  estimates.  Equations  23  and  28  specify 
the  filter  gain  matrix  in  a  way  which  agrees  with  an  intuitive  approach 
to  improving  the  estimate. 

Correlated  Random  System  Disturbances  or  Measurement  Hoise 

The  requirement  that  system  disturbances  and  measurement  noises  he 
strictly  "white  noise"  or  uncorrelated  in  time  can  be  relaxed  to  include 
those  random  quantities  whose  correlation  time  is  much  less  than  any 
characteristic  time  constant  of  the  system  or  measurement  process. 

However,  the  situation  frequently  arises  where  the  random  vectors  >j 
or  v  do  not  satisfy  this  requirement.  In  order  to  make  the  Kalman  Filter 
useful  in  these  cases  it  is  necessary  to  augment  the  state  vector,  l.e, 
to  add  new  quantities  to  those  which  are  estimated.  In  essence,  because 
the  random  disturbance  or  measurement  error  is  slowly  varying,  we  are 
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forced  to  estimate  It  in  order  to  correctly  evaluate  Its  effect  oaths 
estimates  of  the  system  state.  Correlated  signals  can  be  described  as 
resulting  from  the  application  of  an  uncorrelated  input  to  a  linear 
dynamic  system.  In  particular,  a  zero-mean,  exponentially-correlated 
disturbance  is  represented  by  the  output  of  a  first-order  linear  system 
excited  by  white  noise  (see  Section  4).  The  additional  state  variable 
in  the  estimate  provided  by  the  Kalman  Filter  is  the  output  of  this  first- 
order  system,  and  the  original  correlated  system  disturbance  is  replaced 
by  the  uncorrelated  input.  In  this  way  the  augmented  equations  for  the 
system  and  measurement  can  again  be  put  in  the  form  described  earlier  for 
uncorrelated  random  disturbances  and  measurement  noises.  A  second-order 
representation  of  the  correlated  quantity  would  require  two  additional 
state  elements,  etc.  Correlated  measurement  noises  can  be  treated  in  a 
similar  manner,  but  in  the  continuous  filter  application  a  more  complicated 
problem  arises  because  augmenting  the  state  vector  results  in  a  singular 
R  matrix  (Ref.  6). 

Optimum  Prediction.  Smoothing,  and  Parameter  Identification 

Several  modifications  and  extensions  of  the  Kalman  Filter  presently 
exist.  At  the  same  time  that  the  filter  was  developed  it  was  demonstrated 
that  the  optimum  prediction  of  the  system  state  for  some  time  subsequent 
to  the  latest  measurement  is  provided  by  making  the  state  vector  estimate 
obey  the  deterministic  portion  of  the  state  differential  equation.  The 
initial  condition  for  this  equation  is  given  by  the  estimate  immediately 
after  processing  the  most  recent  measurement.  The  error  covariance  for 
the  predicted  state  obeys  Eq.  12  or  14  (if  continuous  formulation  is 
desired)  with  the  initial  covariance  also  given  by  the  value  immediately 
following  the  most  recent  measurement. 

The  Kalman  Filter  has  been  extended  to  the  area  of  post-data  analysis 
or  optimum  smoothing  (Ref.  13).  The  opportunity  to  use  data  taken  both 
prior  to  and  subsequent  to  the  point  in  time  at  which  we  want  to  estimate 
the  system  state  inevitably  permits  better  estimation  accuracy.  Additional 
calculations  aggravate  a  computer-size  problem  that  is  often  serious  with 
the  Kalman  Filter  alone.  Work  has  also  been  accomplished  on  the  problem 
of  estimating  the  parameters  of  a  system  by  measuring  a  noise-corrupted 
linear  function  of  its  state  variables.  Simultaneous  refinement  of  our 
knowledge  of  system  parameters  and  random  forcing  functions  is  also  the 
subject  of  much  work  (see  Ref.  14). 


AN  EXAMPLE 

A  simple  and  amusing  example  will  help  clarify  some  of  the  ideas 
discussed  above.  Figure  11  illustrates  the  example.  The  observer  is 
attempting  to  establish  (estimate)  the  position  of  a  drunk  relative  to 
a  lamp  post  by  observing  both  through  a  telescope.  The  drunk  is 


23 


Sensor  Noise) 

(a)  Scenario 


FIG.  11.  Example:  Drunk  Near  Lamp  Post 
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constantly  taking  random  length  steps  in  rando*  directions.  Tbs  observer *6 
measurements  are  actually  non-linear,  based  on  measured  angle  multiplied 
by  a  varying  range.  However,  It  will  be  assumed  that  the  distance  to 
the  drunk  has  an  average  value  and  deviations  about  iha.t  value  are  small 
compared  to  the  total  distance.  As  a  result,  Che  angle  between  the  drunk 
and  the  lamp  post  is  taken  to  be  linearly  related  to  the  component  of  the 
distance  between  them  which  is  normal  to  the  line  of  sight.  Wotiee  that 
the  component  parallel  to  the  line  of  sight  is  not  observable.  (See 
Section  9.)  The  single  state  variable  involved  in  the  problem  is  the 
position  x.  The  F  matrix  is  xero.  $  and  G  are  scalar  (1  x  1)  identity 
matrix.  H  is  the  scalar  t,  the  mean  distance  to  the  drunk.  The  drunk's 
steps  and  the  measurement  noise  ate  both  assumed  to  be  uncorrelated. 

Q  and  R  are  the  mean  square  values  of  w  and  v,  respectively.  If  measure¬ 
ments  are  taken  at  discrete  points  in  time  which  are  widely  separated 
compared  to  the  frequency  of  the  drunk's  steps,  the  estimates  of  his 
position  will  deteriorate  between  observations.  Correlated  measurement 
errors  would  result  if  the  observer  was  on  a  structure  that  was  swaying 
slowly  compared  to  the  measurement  frequency.  Given  an  initial  value 
for  the  mean  square  error  in  a  priori  knowledge  of  the  drunk's  position, 
the  corrections  to  be  made  to  the  estimate  as  a  result  of  the  measurements 
could  be  calculated. 

If  the  measurements  are  equally  spaced  and  if  the  drunk's  steps  in 
the  observable  direction  x  provide  an  RMS  position  change  of  q  each 
period,  the  error  covariance  of  our  position  estimate  between  measurements 
can  be  written  from  Eq.  12  as 


Pn<-)  =  qZ  + 


(32) 


where  the  lower  case  notation  is  used  to  indicate  scalar  quantities. 

As  a  measurement  is  incorporated,  the  error  covariance  changes  according 
to  Eq .  30 


pnW  <  +  pn-l(+)  rn 


(33) 


where  rn  is  the  RMS  of  the  measurement  error,  expressed  as  a  distance. 
Simplifying  Eq.  33  and  substituting  into  Eq.  23,  the  filter  gair.  is 

.  3*  +  pn-iW 

*1  *  <2  +  pn-l<+>  +  ^ 


(34) 


1  + 


PQ-1(+)  +  qs 
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The  estimate  of  the  distance  x  is  corrected  with  each  measurement  according 
to 


V+>  “  M~>  +  K  K  -  *J~A 

a  a  n  (  a  n  \ 


(35) 


From  Eq .  34  it  can  be  seen  that,  if  the  measurement  noise  is  much  less 
than  either  the  effect  of  the  subject's  movement  between measurements  or 
the  uncertainty  la  uostclOB  flft*r_the  lagt-aeasurHamt.  |pn_x(^|»  then 


ka"  1 


and  the  estimate  of  present  position  closely  approximates  the  most  recent 
observation.  On  the  other  head,  if  r2  is  much  greater  than  the  sum  of  q2 

■“*  Vi(+)' 


v  «  1 

n 

and  each  observation  improves  the  estimate  very  little. 


EXTENSION  TO  NONLINEAR  SYSTEMS 

Though  the  Kalman  Filter  is  optimum  only  when  the  system  differential 
equations  and  measurements  are  linear,  it  has  found  considerable  use  in 
estimating  the  state  variables  of  nonlinear  systems  with  measurements  that 
are  noise-corrupted  nonlinear  functions  of  the  state  variables.  This 
employment  of  the  Kalman  Filter  is  frequently  referred  to  as  the  "Extended 
Kalman  Filter"  (Ref.  15).  It  is  an  intuitive  but  frequently  successful 
application  of  the  Kalman  Filter  in  the  absence  of  truly  optimum  filters 
for  nonlinear  systems. 

Suppose  the  system  whose  state  it  is  desired  to  estimate  obeys  the 
nonlinear  differential  equation 

£  -  f.  (£,  u,  t)  (36) 

and  the  measurements  are  noise-corrupted  nonlinear  functions  of  the  state 
according  to 


z  -  h  (x,  t)  +  v 


(37) 
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If  our  knowledge  of  the  system  state  is  such  that  the  matrices 


? 

H 


3fl 


3h| 

w 


“(SB) 


are  approximately  constant  over  the  range  of  uncertainty  In  x,  then  the 
continuous  Kalman  Filter  gain  matrix  can  be  computed  from  the  above 
linearization  according  to  Eq.  28  and  29  or  $  can  be  determined  from 
Ea.  6  and  the  discrete  filter  gain  calculated.  It  should  be  noted  that 
the  F,  G,  and  H  matrices  computed  from  Eq.  38  can  be  nonlinear  functions 
of  x.  The  continuous  estimate  of  the  state  vector  is  found  from  the 
equation 

x  “  f(jc,  t)  +  Ktji  -  h(2,  t)]  (39) 


Eouatlon  39  is  similar  to  that  used  when  the  system  is  linear  and  linear 
measurements  are  prescribed.  It  differs  only  in  the  ut  of  nonlinear 
system  and  measurement  functions  £  and  h.  Figure  12  illustrates  the 
continuous  Kalman  Filter  for  a  nonlinear  system.  An  alternative  approach 
is  to  precompute  a  nominal  state  trajectory  and  evaluate  F,  G,  aud  H  in 
advance.  This  reduces  the  on-line  computation  necessary,  but  it  suffers 
further  errors  if  the  true  and  nominal  state  differ  significantly. 

These  techniques  are  only  aporoximate.  They  require  that  the  dis¬ 
turbances,  measurement  noises,  and  uncertainties  in  the  state  be  of  such 
a  size  that  the  higher-order  terms  ignored  in  computing  the  error 
covariance  are  insignificant.  If  this  condition  is  not  satisfied,  the 
application  of  the  Kalman  Filter  to  nonlinear  systems  may  be  useless. 

An  iterative  technique  may  be  useful  in  reevaluating  the  matrices  in 
Eq.  38  based  on  making  a  first  estimate,  x^  evaluating  Eq.  38,  then 
recomputing  the  state  estimate,  etc.  (Ref.  16  and  17). 

Another  approach  to  linear  filtering  for  systems  with  nonlinear 
dynamics  and  nonlinear  observations  is  the  use  of  a  one-tu-one  nonlinear 
transformation  to  map  the  nonlinear  problem  into  a  space  in  which  the 
transformed  problem  Is  linear  (Ref.  18).  However,  the  assumption  of 
Gaussian  noise  in  the  transformed  problem  Is  frequently  incorrect. 
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FIG,  12.  Block  Diagram  of  the  Estimation 
Equations  for  the  Extended  Kalman  Filter. 
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lu  brief,  the  Kalman  Filter  can  be  quite  useful  in  estimating  the 
state  variables  of  nonlinear  sys terns .  however,  wore  care  must  be  exercised 
in  checking  theoretical  results  by  mesas  of  simulation.  Because  the 
error  covariance  eeuatlems  provide  only  an  approximate  evaluation  of  the 
estimation  error  statistics,  Monte  Carlo  techniouea  are  required  to  verify 
the  use  of -the  Extended  Kalman  Filter  for  nonlinear  systems .  Wien  the 
Kalman  Filter  pi'udaces  poor  estimates  of  the  state  of  a  nonlinear  system, 
ingenious  changes  can  often  produce  a  useful  modified  version  (Ref.  19). 

SUMMARY 

The  Kalman  Filter  is  a  systematic  approach  to  estimating  the  state 
variables  of  a  linear  system.  It  provides  the  minimum  variance  estimates 
based  on: 


1. 

2. 

3. 

4. 

5. 


Repeated  external  measurements 

An  understanding  of  system  and  measurement  dynamics 
A  statistical  knowledge  of  tht  system  disturbances 
A  statistical  knowledge  of  measurement  errors 
A  statistical  knowledge  of  the  errors  in  determining  the 
initial  state. 


Figure  13  contains  a  summary  of  the  Kalman  Filter  equations. 
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Section  3.  MODELS  OF  INERTIAL  NAVIGATION  SYSTEMS  f 
AND  ERROR  DYNAMICS 


Engineers  using  the  Kalman  Filter  to  Improve  the  accuracy  of  inertial 
navigators  have,  in  part,  been  successful  because  they  possessed  a  good 
understanding  of  the  physical  principles  underlying  inertial  navigation. 

Consequently,  the  succeeding  sections  discuss  haaic-lnertlal  t-insor#,  - 

strapdowi  and  gimballed  inertial  measuring  units,  navigation  usiug  inertial 
measurements,  the  propagation  of  errors  in  an  inertial  navigation  system, 
and  the  external  measurements  used  to  recalibrate. 


INERTIAL  SENSORS 

It  was  noted  earlier  that  the  concept  of  inertial  navigation  is 
quite  simple;  measurement  of  linear  acceleration,  velocity  and  angular 
rate,  and  application  of  Newton's  laws  of  motion.  There  are  two  kinds 
of  sensors  which  are  basic  to  inertial  systems — those  which  measure 
linear  motion  and  those  which  measure  angular  motion. 

Accelerometers 


Linear  motion  is  indicated  by  accelerometers.  As  the  name  implies, 
they  measure  linear  acceleration  though  frequently  the  Instrument  output 
signal  is  the  integral  of  the  measured  acceleration  (l.e.,  velocity 
difference) .  Accelerometers  operate  by  sensing  the  forces  acting  on  a 
proof  mass.  This  force  may  be  indicated  by  a  linear  displacement,  torque 
(through  a  moment  arm),  change  in  the  natural  frequency  of  a  vibrating 
element,  etc.  Figure  14  illustrates  a  pendulous  accelerometer  which 
converts  force  along  the  input  axis  to  torque  about  the  output  axis. 

The  quantity  measured  by  an  ideal  accelerometer  is  often  called  specific 
force  and  represents  the  acceleration  of  the  proof  mass  less  that  portion 
due  to  mass  attraction  (gravitation).  It  is  expressed  by  the  equation1 


f  »  m  (a  -  G)  (40) 

wher£  f  is  specific  force,  a  is  the  acceleration  of  the  proof  mass,  m, 
and  G  is  the  gravitational  attraction  acceleration.  If  m  and  G  are 
known,  acceleration  can  be  calculated  from  the  specific  force.  Acceler¬ 
ometers  typically  measure  specific  force  along  one  axis  fixed  in  the 
Instrument  and  three  such  devices  are  necessary  to  imply  total  accelera¬ 
tion  In  three-dimensional  navigation  space.  It  is  customary,  though 
not  necessary,  to  orient  their  input  axes  to  be  mutually  perpendicular. 


i 

In  the  equations  of  inertial  navigation  systems,  physical  vectors 
will  be  designated  by  an  overbar  to  distinguish  them  from  the  vector 
notation  (underbar)  used  in  discussions  of  the  Kalman  Filter. 
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FIG.  14.  Single- Decree -of- Freedom  Accelerometer. 

Gyroscopes 

The  angular  motion  sensor  used  in  Inertial  navigation  systems  Is  the 
gyroscope.  Two  basic  types  of  gyroscope  exist:  the  so-called  free  or 
two-dograa-of-freedom  gyro  and  t’le  restrained  or  sing] e-degree-of-f reedom 
gyro. 

The  single-degree— of-freedoa  (SDF)  gyro  is  iiluati.ai.eci  in  rig.  15. 

Its  basic  operation  results  from  the  fact  chat  an  angular  rate  about  the 
input  axis  creates  a  torque  about  the  output  axis.  The  torque  is  expressed 
by  the  equation 

Tq  -  (41) 

where  aij  is  the  input  angular  rate  and  H  is  the  rotor  spin  angular 
momentum.  The  single  degree  of  freedom  is  provided  by  permitting  the 
global  to  rotate  relative  to  the  case  about  the  output  axis.  The  girnbal 
angle  is  the  angle  between  the  angular  momentum  vector  and  some  nominal 
orientation  of  H  relative  to  the  case.  If  damping  is  provided  between 
the  gimbal  and  the  case,  the  girnbal  angle  represents  the  integral  of  the 
angular  rate,  a>i,  and  a  rate-integrating  gyro  results.  II  a  restoring 
torque  proportional  to  the  gimbal  angle  is  provided,  the  device  is  called 
a  rate  gyro.  In  either  case  the  sensor  output  is  provided  by  measuring 
the  gimbal  angle.  A  torque  generator  which  provides  torque  to  the 
gimbal  about  the  output  axis  is  also  present  in  oust  applications. 
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FIG.  15.  SlngleHDegree-of -Freedom  Gyro. 


With  the  two-degree-of- freedom  gyro,  use  is  made  of  the  fact  that. 
In  the  absence  of  torques,  the  angular  momentum  vector  keeps  a  fixed 
direction  in  inertial  space.  Therefore,  gyro  case  motions  are  detected 
from  the  relative  orientation  between  rotor  and  case.  Three  SDF  gyros 
are  used  to  sense  the  total  angular  motion  of  an  instrument  package. 

They  are  customarily  oriented  with  their  input  axes  orthogonal.  If  free 
gyros  are  used,  only  two  instruments  are  required. 


INERTIAL  MEASUREMENT  UNITS 


Inertial  navigation  systems  require  an  indication  of  acceleration  as 
the  input  to  the  navigation  equations.  Furthermore,  these  accelerations 
(or  rather  the  acceleration  vector)  must  be  resolved  into  the  coordinate 
frame  in  which  the  navigation  equations  are  computed.  Two  general 
approaches,  described  below,  are  taken  to  the  problem  of  Indicating  inertial 
acceleration  in  the  desired  coordinate  frame.  Both  techniques  employ  an 
instrument  cluster  or  inertial  measurement  unit  (IMU)  which  consists  of 
the  necessary  number  of  gyros  and  accelerometers.  The  inertial  sensors 
measure  acceleration  and  angular  motion  in  a  coordinate  system  fixed  in 
the  IMU.  The  two  schemes  differ  only  in  the  way  they  provide  acceleration 
measurements  resolved  ii  navigation  coordinates. 


Gimballed  Platforms 


The  first  practical  inertial  navigation  systems  mounted  their  sensor 
clusters  on  gimballed  platforms.  Gimbals  permit  isolation  of  the  instru¬ 
ments  from  angular  motions  of  the  carrying  vehicles.  This  isolation  is 
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accomplished  with  the  help  of  the  gyros.  They  Indicate  changes  in  the 
angular  orientation  of  the  platform  relative  to  inertial  space  and,  by 
means  of  glnbal  servos,  the  platform  is  returned  to  its  proper  attitude. 
When  a  rotation  of  Che  platform  relative  to  inertial  spa  \  is  desired, 
output  axis  torque  generators  on  the  gyros  are  used  to  cause  false  indica¬ 
tions  of  angular  rotation.  Because  they  cannot  be  distinguished  from 
actual  inputs ,  theca  fictitious  rotations  provide  platform  reorientation 
in  a  manner  similar  to  that  described  above.  For  more  detail,  the  concept 
of  the  space  Integrator  is  useful  (Ref.  20  and  21).  The  giaballed  plat¬ 
form  permits  accelerometer  measurements  to  be  used  directly  because  the 
sensor  input  axes  can  be  oriented  parallel  to  the  navigation  axes. 

Strapdown  Systems 

The  simplest  way  to  mount  the  instrument  cluster  is  to  attach  it 
rigidly  to  the  vehicle.  This  approach  saves  the  weight  and  power 
associated  with  gimbals  and  gimhal  servos.  But  as  a  result  of  the  fact 
that  the  navigation  equations  are  seldom  implemented  in  vehicle-fixed 
coordinates,  the  accelerometer  output8  mist  be  resolved  into  the  navigation 
axis  system.  The  relative  orientation  between  orthogonal  sensor  input 
axes  and  the  navigation  coordinate  system  is  described  by  a  transformation 
matrix.  If  the  initial  value  of  this  matrix  is  known,  the  gyros  provide 
the  necessary  Information  to  calculate  it  for  all  subsequent  times  during 
system  operation.  The  acceleration  vector,  measured  in  the  vehicle  axes, 
is  then  transformed  into  navigation  axes;  subsequent  data  processing  is 
identical  with  that  of  gimballed  systems.  While  the  strapdown  system 
simplifies  the  hardware  requirements  for  an  IMU,  it  increases  the  require¬ 
ments  for  computer -size,  speed,  and  accuracy  because  of  the  transformation 
matrix  calculations.  Jn  addition,  because  high  Input  angular  rates  are 
experienced,  SDF  gyros  in  strapdown  applications  must  be  provided  with 
high-level  torque  generators. 

Whatever  their  mechanization,  IMU's  use  groups  of  inertial  sensors 
to  indicate  acceleration  resolved  in  the  navigation  coordinate  frame. 

The  two  schemes  discussed  above  are  illustrated  in  Fig.  16. 


INERTIAL  NAVIGATION  SYSTEMS 


The  simplest  fora  of  navigation  using  Inertial  instruments  is  expressed 
by  the  equation 


(42) 


The  vector  R  describes  a  position  relative  to  the  earth's  center.  Its 
second  derivative  as  seen  in  inertial  coordinates  is  given  by  the  properly 
resolved  accelerometer  measurements,  with  the  gravitational  acceleration 


W5JL-4  SSI 


added.  Double  integration  of  Eq.  42  will  provide  indications  of  the 
t Hastens  in  S»  Xn  add i t ion .  if  the  results  ere  to  be  correct ,  the  guidance 
computer  oust  indicate  G  exactly .  the^accelersmeter  muat  have  no  errors, 
and  the  initial  conditions  on  E  and  dK/dt  mist  be  known. 

Host  of  the  discussion  in  this  report  involves  navigation  near  the 
earth.  For  this  problem  three  reference  frames  are  useful.  The  first 
is  the  inertial  franc  already  mentioned,  tn  addition,  a  reference  Frame 
with  origin  at  earth's  center  is  defined.  This  frame  is  lnertlally  non¬ 
accelerating  but  fixed  to  the  earth  and  therefore  rotating  relative  to 
inertial  space  at  a  constant  rate  of  approximately  IS  degrees  per  hour. 

The  rotation  rate  la  represented  by  a  vector,  ft.  The  third  reference 
frame  ia  that  of  the  particular  Inertial  system.  It  has  its  origin  near 
the  earth's  surface,  usually  at  the  position  of  the  vehicle  carrying  the 
sensors.  It,  can  rotate  relative  to  the  earth-fixed  frame  at  a  rate 
designated  p.  For  convenience  the  three  frames  are  called  I,  E,  and  C, 
respectively  (see  Fig.  17).  Ideally,  the  accelerometer  measurements 
are  resolved  into  the  C  frame. 


e 


FIG.  17.  Reference  Coordinate  Frames  for 
Near-Earth  Inertial  Navigation. 
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The  position  of  a  vehicle  near  the  surface  of  eh#  earth  is  usually 
described  by  the  position  vector  resolved  in  the  earth- fixed  or  S 
coordinate  frame .  The  velocity  of  the  vehicle  with  respect  to  the  earth 
is  designated  v  and  expressed  by 


v  » 


M  - 5 


X  R 


(43) 


Equation  43  makes  use  of  a  theorem  of  Coriolis.  The  derivative  of  v 
with  respect  to  the  C  or  navigation  coordinate  frame  is  given  by 


(H  •  (£)« 


p  x  v 


f  C  '  'E 

The  derivative  of  v  with  respect  to  the  E  frame  is  related  by 


\dt 


i  ■  W 


l*Lj\  _  OO  .  H  x  eft  x  R) 

\  dt’/j  “•  \dt/E  n  x  u<  *  R) 


Substituting  from  Eq.  45  into  Eq.  44, 

2H  *  v  -  H  *  (ft  x  r)  -  P  *  v 


/dv\  Id2  R\ 

Vdt/c  "  \  dt7l  " 


Defining 


Eq.  46  becomes 


/dv  \  /dz 

*  r* 


*  r\ 


>c  \  dt2/i 


id  ■  ft  4-  p 


-  (u  +  ft)  X  v  -  n  X  (Q  X  R) 


Substituting  from  Eq.  42, 


(£)c 


—  -  (w  +  ft)  xv  +  G-  fix  (ft  x  r) 
m 


(44) 


(45) 


(46) 


(47) 


(48) 


(49) 
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Vh#u  considering  navigation  near  the  surface  of  the  earth,  it  is  convenient 
to  define  a  new  vector,  gravity.  Because  of  the  earth's  rotation,  the 
local  vertical  or  plush  line  is  parallel  to  the  gravitation  vector  G  only 
at  the  poles .  At  any  other  latitude  the  earth's  rotation  tilts  the  local 
vertical,  §,  so  that  it  is  related  to  the  gravitation  vector  by 

g  -  G  -  ft  *  (ft  x  R)  (50) 

— This  IS  illustrated  in  Fig.  18.  Equation  49  can  be  written  in  terms  of 
the  gravity  vector 


-  -  (to  +  ft)  *  v  +  g 

1 


(51) 


A 


FIG.  18.  Definition  of  Gravity  Vector. 


Equation  51  is  one  of  the  most  convenient  forms  of  the  navigation 
equations  to  implement.  The  left  side  of  the  equation  is  the  derivative 
of  earth-fixed  velocity  with  respect  to  the  navigation  frame.  The  first 
term  on  the  right  is  provided  by  the  accelerometers  and  theorems ining 
two  terms  can  be  calculated  from  position  and  knowledge  of  p.  The 
computer  solves  Eq.  51  for  the  vehicle  velocity  vector_in  the  navigation 
frame.  Then  a  second  integration  provides  changes  in  R  relative  to  the 
earth-fixed  coordinate  frame. 
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Several  choices  of  che  navigation  frame,  C,  are  eomsoaly  used  for 
near-earth  navigation.  They  differ  basically  in  the  way  the  vector  u  is 
prescribed.  The  three  most  popular  are: 

1.  North — vertical 


-  -  Center  at  present  vehicle  location 

x — horizontal,  north 
y — horizontal,  east 
z — vertical  (down) 

2.  Free  azimuth2 

Center  at  present  vehicle  location 
x — horizontal,  at  known  (variable)  angle  with  north 
y— horizontal,  at  known  (variable)  angle  with  east 
z — vertical  (down) 

3.  Tangent  plane 

Center  at  a  nominal  vehicle  location 
x — initial  north 
y — initial  east 
z — initial  vertical  (down) 

The  first  two  coordinate  systems  are  called  "locally  level"  because 
their  x-y  planes  are  always  tangent  to  the  earth  at  the  vehicle  position. 
These  are  usually  found  in  cruise  vehicles  (aircraft,  submarines,  ships) 
which  travel  long  distances.  The  third  system  Is  referred  to  as  "launch 
point  level”  and  is  used  in  missile  applications  and  for  navigation  over 
small  areas. 


ERfiORS  IN  INERTIAL  NAVIGATION  SYSTEMS 

It  is  impossible  to  implement  inertial  navigation  systems  without 
errors.  However,  these  errors  can  be  kept  within  acceptable  bounds 
through  the  use  of  external  measurements.  Presently,  the  predominant 
error  sources  are  imperfect  indications  of  motion  as  provided  by  the 
gyros  end  accelerometers  as  well  as  limited  knowledge  of  the  direction 
of  g.  Gyro  errors,  called  drift  rates,  will  be  designated  in  vector 
form  by  T,  and  accelerometer  errors  are  designated  V.  Many  inertial 


*  In  this  case  the  z  component  of  w  is  zero.  A  related  system, 
often  called  "wander  azimuth,"  has  the  z  component  of  w  equal  to  the 
z  component  of  R. 
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navigation  systen  errors  not  das  to  false  Initial  conditions  are  caused 
by  effects  watch  can  be  lushed  into  the  terms  t  and  9, 

Using  standard  perturbation  techniques,  the  affect  of  these  errors 
on  the  navigation  computations  can  be  determined.  Appendix  C  derives 
the  inertial  navigator  error  equations  for  near-earth  systems.  It  also 
deaoast rates  the  basic  instability  that  appears  in  the  navigation  equa¬ 
tions  for  the  vertical  direction.  The  error  equations  are  expressed  in 
vector  fora  in  terms  of  the  position  vector  in  an  earth-fixed  coordinate 
frame,  R;  Inertial  angular  rate  vector_of  the  navigation  coordinate  ; 

frame,  W,  earth  rotation  rate  vector,  8;  angle  between  computer  indica-  , 

tion  of  the  navigation  coordinates  and  the  axis  system  in  which  accelero¬ 
meter  outputs  are  actually  resolved,  and  the  specific  force  vector  } 

and  instrument  errors  1 


1 

■  | 

a 

i 

R  (52)  | 

9 

I 

1 

a  t 

'  ? 


where 


15?  -f  2(0  *  ^R  +  0)  * 


+•  U  X  (u  X  5R)  -  n  X  (n  X  6ft)  , 


ip  x  —  +  7  -  2w  (6w  ) 

r  B  8  S 


L+  toz  6R 


and  the  dynamics  of  are  described  (see  Appendix  C)  by 


(53) 


$  »  x  u  +  e 


(54) 


The  errors  in  navigation  quantities  are  the  state  variables  in  the 
Kalman  Filter.  By  substituting  the  proper  relation  for  ui  into  Eq.  52 
and  54,  the  F  or  i  matrices  required  In  Eq.  12  and  14  can  be  defined. 
The  error  relations  can  also  be  diagramed.  Figure  19  illustrates  the 
propagation  errors  in  a  north-vertical  system. 


EXTERNAL  MEASUREMENTS 

In  order  to  keep  the  errors  generated  in  an  inertial  navigation 
sy8ten  within  acceptable  levels,  it  is  necessary  to  recalibrate  the  s\  -em 
periodically.  The  recalibration  or  correction  of  system  errors  is 
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achlri^id  with  the  use  of  independent  sources  of  information.  Those 
external  measurements  include  position,  velocity,  attitude,  and  combina¬ 
tions  thereof.  Typical  sources  are: 

Position— ’Radio  navigation  aide  (Loran,  Omega,  Tacan,  etc.) 
navigation  satellites 

- Star  sights 

Landmarks,  identified  and  unidentified 
Radar 

Map  matching 

Veloclty—Doppler  radar 

Electromagnetic  speed  log 

Attitude— Star  sight 

Horizon  meaaurements 

The  external  measurements  are  compared  to  corresponding  quantities 
indicated  by  the  inertial  navigation  system,  and  system  and  random  meast  re- 
ment  errors  are  related  linearly  to  the  difference.  This  linear  relation 
between  Inertial  system  errors  and  the  formed  differences  between  measured 
and  Indicated  values  of  Dosition,  velocity,  and  attitude  specifies  the 
H  matrices  in  Eq.  18  and  26.  The  Kalman  Filter  uses  the  differences 
between  Indicated  and  measured  quantities  to  provide  the  optimum  estimate 
cf  the  inertial  navigation  system  errors.  Inertial  sensor  errors  such 
as  gyro  drift  rate  and  accelerometer  errors  are  also  estimated.  Corrections 
may  th  r  be  applied  to  the  system,  based  on  the  error  estimates.  Figure  20 
illustrates  the  procedure.  A. wore  detailed  description  of  the  manner  in 
which  the  corrections  are  applied  ir  found  in  Section  6. 
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Indicated  Position,  Measured  Position, 
Velocity  and  Velocity  and 


FIG.  20.  Block  Diagram  oi  Recalibration  Scheme 
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Section  4.  CORRELATED  ERROR  DYNAMICS  FOR  SENSORS 


The  Kalman  Filter  equations  displayed  in  Section  2  were  developed 
with  the  assumption  that  the  system  disturbances  (u(t)  or  w^)  and  measure 
sent  errors  <v(t)  or  Vg)  were  not  con-elated  in  time.  The  strict  require 
meat  of  "whits  noise"  disturbances  and  measurement  errors  can  be  relaxed 

- Ss- Include  those  quantities  whose  correlation  time  is  much  less  then  the 

characteristic  tinea  of  the  system  or  of  the  measurements.  In  either 
case,  the  lack  of  correlation  is  an  indication  that  nothing  can  be  gained 
by  estimating  the  disturbances  and  errors  themselves,  i.e.,  if  an 
accurate  estimate  was  available  it  would  not  help  predict  the  state  at 
the  next  time  of  interest.  However,  when  the  disturbances  and  measure¬ 
ment  errors  are  not  changing  rapidly  compared  with  the  system  state  or 
measurements,  the  filter  accuracy  can  be  enhanced  by  estimating  these 
additional  quantities;  the  filter  estimates  of  u(t)  and  v(t)  are  used 
to  more  accurately  predict  system  behavior. 

The  estimation  of  system  disturbances  and  measurement  errors  which 
have  significant  time  correlation  is  frequently  described  as  "state 
vector  augmentation."  That  is,  the  number  of  state  variables  to  be 
estimated  is  increased  by  including  these  quantities.  Also,  their 
dynamic  behavior  is  described  in  the  appropriate  rows  of  an  enlarged 
F  (or  9)  matrix  which  specifies  the  unforced  behavior  of  the  augmented 
state  vector.  Because  these  quantities  are  random,  their  behavior 
cannot  be  described  deterministically.  Instead,  they  are  usually  taken 
to  be  the  state  variables  of  a  fictitious  linear  dynamic  system  which 
is  excited  by  white  noise.  This  model  serves  two  purposes;  it  provides 
-tha  proper  autocorrelation  characteristics  through  specification  of 
th-i  linear  system  and  the  strength  of  the  driving  noise,  and,  in 
addition,  the  random  nature  of  the  signal  follows  from  the  random 
excitation.  The  differential  equation  for  the  augmented  state  is  in 
the  proper  form  for  the  Kalman  Filter — a  deterministic  system  excited 
by  an  uncorrelated  random  signal.  When  measurement  noise  quantities 
are  included  in  the  augmented  state  vector,  some  of  the  newly-defined 
measurement  vector  elements  do  not  contain  noise.  As  a  result,  the 
matrix  R  1  is  undefined  anti  modifications  must  be  made  to  the  equations 
of  Section  2  for  the  continuous  filter  (see  Ref.  6).  All  correlated 
system  disturbances  and  measurement  errors  for  inertial  navigation 
systems  can  be  described  to  a  good  approximation  by  a  combination  of  one 
or  more  of  the  several  types  of  behavior  described  in  this  section. 


STATE  VECTOR  AUGMENTATION 

The  augmentation  of  the  state  vector  to  account  for  correlated 
disturbances  can  be  illustrated  using  Eq.  2 

i  «  Fx  +  Gu  (55) 
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Suppose  u  was  composed  of  correlated  quantities  .u^  and  uncorrelated 
quantities  u^,  _ 

u  "  u  +  u  (56) 

—  -*1  — i 

If  can  be  modeled  to  obey  a  differential  equation  _ 

u  *  F  u  +  u  (57) 

—l  u  “1  “3 


where  u  is  a  vector  composed  of  uncorrelated  quantities,  then  the 
augmented  state  vector  *'  is  given  by 


(58) 


and  the  augmented  state  differential  equation,  driven  only  by  uncorrelated 
disturbances,  is  given  by 


(59) 


To  illustrate  state  vector  augmentation  to  account  for  correlated 
measurement  noise,  ruppose 


x  =  Fx  +  Gu 


z  =  Hx  +  v 


(60) 


where  u  Is  a  vector  of  uncorrelated  disturbances,  but  v  is  the  sum  of  a 

correlated  measurement  noise  vector,  v  ,  and  uncorrelated  errors,  v  , 

“1  ~~2 


V,  +  va 


(61) 


If  the  correlated  measurement  errors  are  modeled  to  obey  the  white~nolse 
driven  differential  equation 


y.  =  F„  y,  u _ 


(62) 


tha  augmented  state  vector  x'  obeys  the  differential  equation 


V 


V 

F 

0 

_ - 

X 

.  r 

L  J 

■  - 

e 

>• 

Ifh 

h 

it 

G 

if] 

r 

u 

G 

T 

1  ! 

L 

t 

-V 

(63) 


and  the  measurement  obeys 


a  ■  (H  1 1]  x'+ 


(64) 


If  v2  has  one  or  more  zero  elements  (one  or  more  measurements  do  not 
contain  uncorrelated  errors)  the  R  matrix  has  a  corresponding  number  of 
zero  rows  and  columns.  As  a  result,  R-1  does  not  exist  and  a  modification 
to  the  continuous  Kalman  Filter  is  necessary  (Ref.  6). 3 


CORRELATION  MODELS 
Random  Constant 


The  random  constant  is  a  nondynamic  quantity  with  a  random  amplitude. 
Nevertheless,  if  it  is .known  to  exist,  the  random  constant  must  be 
included  among  the  elements  of  the  augmented  state  vector. 

x  -  0  (65) 

Its  constant  nature  is  indicated  by  the  fact  that  the  rows  of  the  F  and 
G  matrices  corresponding  to  this  quantity  contain  only  zeros.  In  the 
discrete  formulation,  the  element  at  the  intersection  of  the  correspond¬ 
ing  row  and  column  of  the  $n  matrix  is  unity  while  the  remaining  elements 
of  the  pertinent  row  are  zeros.  The  corresponding  row  and  column  of  the 
matrices  G  Q  or  Qa  contain  only  zeros.  Figure  21  illustrates  the 
nature  of  $n,  w.a,  and  Qa  when  one  state  variable  is  a  random  constant. 

The  random  constant  can  be  pictured  as  the  output  of  an  integrator  with 
no  input  but  having  a  random  initial  condition. 


i 

t 


I 


^Recent  work  suggests  that  state  vector  augmentation  may  not  be 
necessary  when  correlated  measurement  noise  Is  present  (Ref.  22). 
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0 

Qn  = 

0 

0 

0  • 

0 

X2  is  a  Random  Constant 


FIG.  21,  Illustration  of  <J>n,  wn,  and  Qn  When  One 
State  Variable  is  a  Random  Constant. 


Random  Walk 


The  random  walk  results  when  uncorrelated  signals  are  integrated. 
It  derives  its  name  from  an  illustration  involving  a  man  who  takes 
fixed-length  steps  in  arbitrary  directions  (see  p.  24).  In  the  limit, 
when  the  number  of  steps  is  large  and  their  length  is  small,  the 
distance  travelled  in  a  particular  direction  looks  like  the  random  walk 
variable.  The  state  variable  differential  equation  for  this  quantity 
is  given  by 


(66) 
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where  E  [u(e)u(t)J  »  q  (t)6 (t-T) .  A  block  diagram  representation  of 
this  equation  is  shown  in  Fig.  22(a).  The  mean  square  value  of  the 
random  walk  variable  grows  linearly  with  time  according  to 

x7  -  qt*  (67) 


The  row  of  the  f  and  ♦  matrices  which  correspond  to  a  random  walk  vari- 
able  are  the  same  as  for  a  random  constant  but,  in  general,  Gu  or  w„ 
provide  finite  contributions  to  changes  in  the  state  variable.  The 
corresponding  column  and  row  of  G  Q  can  be  non-zero  and  the  element 
at  their  intersection  is  given  from  Eq.  67  by  q.  For  Qq  the  appropriate 
element  is 


<*(tn+l  -  *") 


The  random  walk  and  random  bias  can  be  represented  together  with  the 
use  of  only  one  additional  state  variable.  This  1b  illustrated  in 
Fig.  22(b). 


* 

This  is  readily  shown  using  Eq.  .14,  Since  F  is  zero  and  G  is 
unity  the  derivative  of  P  is  Q.  Using  the  lower  case  to  denote  scalar 
quantities, 


p  ■  qt  +  p(0) 

Since  there  are  no  measurements,  &  is  zero  and 
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(a)  The  Random  Walk 


i.c. 


(b)  The  Random  Walk  and  Random  Constant 

FIG.  22.  Block  Diagrams  Demonstrating 
the  Combination  of  Random  Constant  and 
and  Random  Walk  in  One  Additional 
State  Variable. 


Exponentially-Correlated  Random  Variable 

A  random  quantity  whose  autocorrelation  function  is  a  declining 
exponential 


Txx 


o*e“PlTi 


(68) 


is  frequently  a  useful  representation  of  errors  and  disturbances  in 
inertial  navigation  systems.  The  same  quantity  provides  a  reasonable 
approximation  for  a  band-limited  signal  whose  spectral  density  is  flat 
for  a  finite  bandwidth  of  frequency.  The  exponentially-correlated 
random  variable  can  be  generated  by  passing  an  uncorrelated  signal 
through  a  linear  first-order  feedback  system.  A  block  diagram  for  the 
system  is  shown  in  Fig.  23.  The  differential  equation  of  the  additional 
state  variable 11  is  - 


X  «  -0X  +  u 


(09) 
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The  Mean  square  value  of  the  exponentially-correlated  random  variable 
is  constant  if  the  mean  square  initial  condition  on  the  integrator  is 
taken  as  ifi.  The  specification  of  this  quantity  appears  at  the  inter¬ 
section  of  the  appropriate  row  and  column  in  the  initial  error  covari¬ 
ance  matrix,  ?(tg).  The  corresponding  diagonal  element  (at  the  inter¬ 
section  of  the  appropriate  row  end  column)  of  the  F  matrix  is  -3.  All 
other  elements  of  the  coresponding  row  are  zero.  The  $  matrix  is 
similarly  arranged  with  the  diagonal  element  given  by 

.MW  - 

The  G,  G  Q  GT  and  Qn  matrices  have  the  same  characteristics  as  for  the 
randoa  walk.  The  mean  square  valua  of  x  is  related  to  q  by 


^  -  JL  * 


It  is  interesting  to  note  that,  when  the  period  of  estimation  is  much 
less  than  che  time  constant  1/3,  an  exponentially-correlated  quantity 
can  be  approximated  by  the  randoa  walk.  Under  this  condition  an 
exponentially-correlated  variable  and  a  random  constant  can  be  approxi¬ 
mated  by  only  one  additional  variable. 


♦  ftatfOM  ramp 


FIG.  23.  Block  Diagram  Showing  Generation 
of  Three  Random  Characteristics  by  the 
Addition  of  Only  Two  State  Variables. 


*  Again,  Eq.  14  can  be  employed.  Since  F  = — 3  and  G  -  I, 


p  “  -23p  +  q 


In  the  steady  state,  p  ■  0,  and  p  »  -Sr  . 
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Periodic  Rsndon  Quantities 

Random  variables  which  exhibit  a  periodic  secure  may  also  arise  In 
Inertial  navigation  systems.  Their  autocorrelation  functions  can  be 
represented  by 


$  (t) 

Txx 


cos  n 


-C  t 

e  {cos(w' | T  f  — n>  3 


(71) 


where 


«'  -  wn(l  - 


(72) 


and  the  values  of  £  and  are  chosen  to  fit  empirical  autocorrelation 
data.  Two  additional  state  variables  are  necessary  to  represent 
random  signal  with  this  autocorrelation  function.  One  pair  of  state 
quantities  which  provides  this  relation  is  given  by 


XZ  "  Ki+1  +  au 


k-rl  =  -  2«Vi+l  +  (b  -  2aCt°n)u 


(73) 


where 


2  20 

a  =  “*»  sin(a~n) 
fa2  °  ^3Tn  sin(a+n) 

a  =  tan  1  (  (1  _  52)1/2  J 

and  has  its  autocorrelation  function  given  in  Eq.  71  (Ref,  23). 


(74) 
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Random  Rasp  Variables 

Frequently,  random  errors  arise  in  Inertial  ays tens  which  exhibit 
a  definite  tiae-growiax  value.  The  random  ramp,  a  function  which  grows 
linearly  with  time,  can  be  used  to  describe  them.  The  growth  rate  of 
the  random  ramp  is  a  random  quantity  with  a  given  probability  density. 
Two  additional  state  elements  are  necessary  to  describe  the  random 
ramp: 


x£  “  x£+l 


X£+l  “  0 


(75) 


where  the  initial  condition  on  x£+j.  provides  the  9lope  of  the  ramp. 
This  initial  condition  is  exhibited  in  the  form  of  a  mean  square  slope 
I?,  which  appears  in  the  corresponding  diagonal  element  of  the  initial 
error  covariance  matrix  P(t0).  xj,  is  the  random  ramp  quantity.  The 
row  of  the  F  matrix  which  corresponds  to  X£  has  a  one  on  the  column 
corresponding  to  x£+i  and  zeros  everywhere  else.  In  the  $  matrix  the 
same  element  is  specified  by  (t^i  -  t„)  and  there  are  ones  on  the 
diagonal.  The  row  in  the  F  matrix  which  is  related  to  x£+i  contains 
only  zeros.  The  rows  of  G  and  the  rows  and  columns  of  G  Q  G1  or  Qn 
which  correspond  to  xg,  and  x£+j  are  also  empty.  The  mean  square  value 
of  xg  grows  as  a  parabola  with  time 


xj  *  r*  ts 


(76) 


The  random  ramp,  random  walk,  and  random  constant  can  be  represented 
together  by  the  use  of  only  two  additional  state  variables.  This  is 
illustrated  in  Fig.  23. 

A  summary  of  the  above-described  random  quantities  is  given  in 
Fig.  24.  Occasionally  other  more  complex  random  error  models  arise. 
For  example.  Ref.  24  discusses  a  time-  and  distance-correlated  error 
whose  autocorrelation  function  is  given  by 


4>(t,d)  -  c‘ 


T,  d  >  0 


(77) 
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FIG.  24.  Random  Variables 
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where  a  and  b  are  a  f < rst-order  correlation  time  and  a  first-order 
correlation  distance,  respectively.  A  similar  correlation  ap,  are  to 
occur  in  certain  radio  navigation  systems.  However,  the  vast  majority 
of  inertia i  navigation  system  measurement  errors  and  disturbances  can 
be  described  by  some  combination  of  the  random  variable  relations 
summarized  in  Fig.  24. 

INERTIAL  SENSOR  ERRORS 

Random  inertial  sensor  errors  are  produced  by  many  practical  and 
theoretical  imperfections  in  the  operation  of  these  instruments.  They 
are  among  the  major  random  disturbances  for  inertial  navigation  systems. 
Through  extensive  testing  and  detailed  knowledge  of  the  sensor  dynamics 
many  other  errors  are  measured  and  compensated  or  removed  by  careful 
design.  But,  when  all  the  tests  for  predictable  errors  and  the  ingenious 
design  tricks  have  been  exhausted,  there  still  remain  errors  whose 
source  and  systematic  behavior  defy  detection.  Often  additional  testing 
reveals  that  the  statistical  behavior  of  these  inertial  se.nsor  errors 
can  be  described  by  one  or  more  of  the  forms  presented  in  the  previous 
section.  It  should  be  emphasized  that  the  pertinent  statistical  param¬ 
eters  (mean  square,  correlation  time,  etc.)  are  only  obtained  through 
the  analysis  of  large  amounts  of  data.  Frequently  the  error  behavior 
observed  is  highly  dependent  on  the  individual  instrument  tested  or  the 
period  of  observation.  Therefore,  it  is  not  surprising  chat  complete 
agreement  on  inertial  sensor  error  models  does  not  exist. 

The  statistical  model  of  Inertial  sensor  errors  also  depends  greatly 
on  the  operating  situation.  If  the  errors  in  a  cruise  inertial  navigator 
are  being  estimated,  a  very  detailed  model  may  be  required.  On  the 
other  hand,  errors  in  a  tactical  missile  navigator  can  be  determined 
accurately  with  simpler  models  for  sensor  error  statistics. 

Gyro  Drift  Rate 

In  one  ease  or  another,  ail  of  the  random  variables  described  in 
Fig.  24  except  the  periodically-correlated  quantity  have  been  found  to 
be  good  descriptions  of  gyro  drift  rate.  Reference  25  propcsea  the 
combination  of  random  bias,  exponentially-correlated  error,  and  a  random 
walk  as  a  good  statistical  model  of  the  gyro  drift  rate.  In  this  case 
the  initial  condition  for  the  integrator  in  the  system  generating  the 
exponentially-correlated  component  is  taken  as  zero.  Further  studies 
reveal  that  the  random  raep  may  be  a  necessary  addition  in  order  to 
describe  gyro  drift  rate  more  completely.  It  can  be  seen  that  two  or 
three  additional  state  variables  must  be  added  for  each  gyro. 
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Accp lefoine*  er  Error  j 
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Arrpj./»romecer  ermcj  arc  usually  described  in  Leims  of  random  ; 

constants  anti  exponentially-correlated  errors  only.  Two  additional  j 

state  variables  are  required  to  represent  the  correlation  propertlei. 
ot  thane  errora, 

j 

Although  it  is  not  an  accuierome ter  error  per  se,  gravity  deflection  j 

of  the  vertical  can  be  modeled  as  an  exponentiaiiy-eorreiated  disturbance 
originating  in  the  level  accelerometers  of  an  inertial  system.  This  3 

particular  geodetic  error  is  of  great  importance  in  the  long-range  or 
cruise-type  vehicle.  While  the  phenomenon  is  spatially  fixed,  an 
equivalent  correlation  time  can  be  derived  by  dividing  the  actual  3 

correlation  distance  by  vehicle  speed.  Vehicle  maneuvers,  of  course, 
have  to  be  properly  treated  In  this  calculation.  -  = 


MEASUREMENT  ERRORS 

The  measurements  of  position,  velocity,  and  attitude  used  by  the 
Kalman  Filter  to  improve  the  accuracy  of  inertial  navigation  systems 
may  also  contain  errors  whose  correlation  times  are  significant.  The 
procedure  for  incorporating  additional  variables  into  the  system  in 
order  to  estimate  the  correlated  measurement  errors  is  demonstrated  on 
p.  45. 

The  statistical  properties  of  measurement  errors  are  obtained  ir;  a 
manner  similar  to  those  for  sensor  errors — physical  evaluation  and 
analysis  of  largo  quantities  of  data.  Frequently,  measurement  errors 
can  be  reduced  by  averaging  a  uuisy  measurement  over  a  period  which  is 
long  compared  to  the  error  correlation  time  but  short  with  ’"espect  to 
characteristic  times  of  the  quantity  being  measured. 

Position  Measurements 


Radio  position  Indication  schemes  such  as  Loran  or  Omega  contain 
errors  which  can  be  viewed  as  a  random  bias  plus  an  exponentially- 
correlated  quantity.  The  characteristic  times  of  the  exponential  auto¬ 
correlation  functions  are  in  the  range  of  3  to  15  minutes  for  Loran  C 
and  1  hour  for  Omega.  This  model  of  radio  navigation  uncertainties  is 
approximate  because  position  itself  affects  the  errors.  However,  the 
approximation  is  valid  for  slowly-moving  vehicles  such  as  ships.  The 
radiometric  sextant  (i.e.,  sun  or  moon  tracker)  is  used  to  determine 
position  and  also  serves  to  illustrate  errora  which  can  arise  in 
attitude  measurements  with  radio  instruments.  Its  angle  measurements 
a,o  corrupted  by  white  noise,  random  constant,  and  exponentially- 
correlated  errors.  These  can  be  converted  into  similar  errors  in 
position  Indication  through  knowledge  of  the  measurement  geometry. 
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Velocity  Measurement 

Doppler  velocity  measurements  contain  correlated  errors.  These 
errors  may  differ  for  along-track  velocity  measurements  and  across- 
track  velocity  (Ref.  26).  However,  it  has  been  shown  (Ref.  2)  Uiat 
averaging  Doppler  measurements  over  a  short  period  of  time  will  reduce 
the  size  of  the  measurement  errors  and-  permit-  them  to  be  considered 
as  uneorreleted.  A  ship's  EM  log  has  an  apparent  error  if  any  ocean 
current  exists.  It  is  usually  modeled  as  a  random  constant  plus  error 
which  is  exponentially  correlated  in  position.  The  position  correlation 
coefficient  is  then  converted  Into  a  characteristic  time  by  dividing  it 
by  ship's  speed. 

Attitude  Measurement 


ALtltude  measurement  errors  in  a  radio  sextant  have  already  been 
discussed.  They  are  characteristic  of  al)  attitude  sensors  whlcn 
measure  electromagnetic  radiation  below  the  visible  range.  Optical 
measurements  of  attitude  in  which  the  light  path  passes  through  an 
atmosphere  are  also  subject  to  exponentially-correlated  errors.  Attitude 
measurement  instruments  (possibly  Including  effects  due  to  the  man 
operating  them)  also  provide  random  constant  and  uncorrelated  errors. 

A  discussion  of  random  system  disturbances  and  measurement  errors 
is  necessarily  Incomplete.  Each  inertial  sensor  end  measurement  device 
to  be  used  in  a  system  employing  the  Kalman  Filter  must  have  its  errors 
carefully  analyzed  before  a  proper  error  model  can  be  determined. 
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Section  5.  APPM CATION  TO  NAVIGATION  SYSTEMS 


Dlffe  ential  equations  describing  the  propagation  of  ir.eEtial 
navigation  system  errors  have  been  developed  and  Llie  use  of  the  Kalman 
Kilter  iJshit !D*-d ,  Ah  already  hinted,  the  filter  will  estimate  the  errors 
in  the  inertial  navigation  system  rather  than  the  system  variables 
themselves.  It  is  the  error  quantities  whose  dynamics  can  be  described 
in  terns  of  linear  equations  which,  though  noL  exact,  ate  an  excellent 
approximation.  In  this  section  state  vectors  era  defined  and  the  system 
matrices  F,  corresponding  to  different  system  configurations,  are 
extracted  from  tha  error  differential  equations.  Given  F,  it  is 
possible  to  compute  the  <t>  matrices  of  the  discrete  filter  formulation. 

In  addition,  the  measurement  matrices,  H,  are  specified  for  common 
external  measurements.  Also,  the  effects  of  random  system  disturbances 
and  measurement  errors  are  described  in  terms  of  the  (1,  (j,  and  H  matrices. 
Th  a  section  is  concluded  by  stating  all  of  the  matrices  required  to 
estimate  Che  errors  in  a  north-vertical  inertial  navigation  system  and 
displaying  some  results  from  the  Kalman  Filter  error  covariance  equation 
for  that  case. 


NAVIGATION  COORDINATE  SYSTEMS 

To  begin,  a  more,  detailed  exposition  Is  made  of  the  three  inertial 
navigation  coordinate  frames  outlined  under  Inertial  Navigation  Systems 
(p.  35)  and  in  Appendix  (J. 

North- Vertical  Coordlnat es 

Currently ,  the  most  common  set  of  coordinate  axes  used  for  inertial 
navigation  in  long-term  cruise  systems  such  as  SINS  is  the  orthogonal 
triad-oriented  north  horizontal  (x),  east  horizontal  (y),  and  vertical 
downward  (z).  These  axes,  subsequently  called  north-vertical  coordinates, 
or  a  similar  set  oriented  north  horizontal,  east  horizontal,  and  vertical 
upward,  always  have  their  center  at  the  vehicle  position  and  permit 
easy  calculation  of  navigation  quantities  such  as  longitude  and  latitude. 
Ip  a  gimballed  north-vertical  system,  the  platform  is  rotated  relative 
to  Inertial  space  about  its  nominal  x,  y,  and  z  axes  according  to  Eq.  47. 


oj  ■  (\  +  ft)  cos  L 
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w  “  -  (A  +  0)  sin  L 
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where  X  and  L  are  the  computed  values  of  'longitude  and  latitude  and  it 
Is  the  magnitude  of  the  eart  *a  angular  rate  (bee  Fig,  25),  Of  course, 
srrore  in  the  lnr.  foment  at  ion  of  Eq.  78  may  arise  due  to  gyro  drift  rates, 
etc.  If  thu  computed  values  of  A  and  L  are  correct  and  the.  platform  is 
initially  aligned,  Eq.  78,  when  Implemented  without  error,  will  keep  the 
t\,o  coordinate  frames  parallel.  In  a  strapuown  system,  the  same  rotation 
la  accomplished  by  supplying"  the  required  angular  rate  to  the ■ direction 
cosine  computations. 

Free  Azimuth  Coordinates 

Some  inertial  navigation  systems  do  not  provide  a  platform  rotation 
command  about  the  vertical  axis.  This  eliminates  the  torqulng  error 
associated  with  the  z  gyro,  which  ordinarily  displays  poorer  drift  rate 
characteristics  than  either  of  the  gyros  with  horizontal  Input  axes. 

These  "free  azimuth"  navigation  systems  indicate  the  direction  of  north 
by  calculating  the  angle  between  horizontal  north  and  one  of  the  instru¬ 
mented  horizontal  platform  axe6.  For  calculation  of  longitude  and 
latitude  the  accelerometer  outputs  are  resolved  into  north  and  east 
components  through  this  angle.  The  platform  angular  rates  are: 
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(Si  +  \\ 


cos  L  cos  a  -  I.  sin  a 


“  -(SI  +  A)  cos  L  sin  a  -  L  cos  a 


os  «*  0 
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(79) 


where  a  la  the  horizontal  angle  between  north  and  the  platform  x  axis. 

In  a  scasa,  the  free  azimuth  system  is  u  hybrid  of  gimballed  and 
strapdown  systems,  storing  one  angular  relation  in  the  form  of  the  off- 
azimuth  angle  and  nulling  others  by  keeping  the  platform  level.  Several 
refinements  on  this  scheme  occur.  These  include  defining  a  false  north 
direction  in  order  to  avoid  high  azimuth  rates  ear  the  earth's  geographic 
poles.  Free  azimuth  coordinates  are  frequently  used  for  aircraft 
inertial  navigation  systems  where  high  platform  angular  rates  about  the 
z  axis  can  be  required  of  a  north-vertical  system. 

Tangent  Plane  Coordinates 


The  use  of  tangent  plane  coordinates  Is  another  technique  for 
eliminating  the  errors  resulting  from  platform  rotation  it  takes 
advantage  of  the  fact  that  constant  platform  angular  rates  can  be 
generated  much  more  accurately  than  time-varying  ones.  By  defining 
the  navigation  axes  to  be  those  which  coincide  with  the  north-vertical 
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axe 8  at  a  fixed  point  on  the  earth  (see  Fig.  26)  only  the  horizontal 
and  vertical  components  of  the  earth  rate  at  this  point  must  be 
implemented.  These  rates  are  constant  functions  of  the  fixed-point 
latitude,  Lc,  and  (2. 


uj  ■*  ft  cos  L„ 
x  0 


co  ■  0 

y 

co  ■  -52  sin  Lr 


Tangent  plane  coordinates  are  usually  used  in  inertial  navigators  which 
do  not  compute  latitude  and  longitude.  They  are  found  in  short-range 
vehicles  such  as  airborne  tactical  missiles  whose  target  location  is 
often  measured  directly  in  the  tangent  plane  coordinate  frame.  If  the 
vehicle  carrying  a  tangent  plane  inertial  navigation  system  moves  more 
then  a  fev  miles  frem  the  fixed  point,  mass  attraction  forces  must  be 
calculated  along  the  x  and  y  axes  in  order  to  compensate  accelerometer 
outputs. 


SYSTEM  STATE  DIFFERENTIAL  EQUATIONS 

The  system  matrix  F  describes  the  unforced  behavior  of  the  system 
state  variables  according  to  the  equation 


When  discrete  calculations  of  the  state  vector  are  considered,  F  is  used 
to  compute  the  transition  matrix  $  as  described  in  Section  2.  Of  course 
F  is  dependent  on  the  specific.  (fTOLe  variables  chosen  and  the  order  in 
which  they  appear  in  the  state  vector.  Reordering  the  same  state 
variables  only  requires  shifting  rows  and  columns  in  F.  The  inertial 
navigation  system  error  quantities  which  constitute  appropriate  state 
variables  can  be  writcen  in  identical  form  for  all  three  navigation 
coordinate  frames  discussed  above 
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Notice  that  position  and  velocity  in  the  z  or  vertical  direction  are 
not  included  as  errors  of  the  inertial  system.  The  assumption  is  made 
that  these  quantities  are  obtained  from  some  other  source  because  of 
the  basic  instability  which  exists  in  instrumenting  the  vertical  channel 
of  an  inertial  navigation  system  (see  Appendix  C) .  Special  assumptions 
must  be  applied  to  the  tangent  plane  coordinate  frame  implementation  to 
keep  its  error  equations  similar  to  those  of  north-vertical  and  free 
azimuth  systems;  the  effects  of  errors  due  to  inaccurate  indication  of 
mass  attraction  forces  along  the  x  and  y  axes  are  ignored  and  it  is 
assumed  that  the  local  vertical  does  not  differ  from  the  fixed-point 
vertical  by  more  than  ?  few  degrees.  Systems  employing  the  tangent 
plane  coordinate  axes  usually  permit  these  simplifications. 

The  state  vector  defined  by  Eq.  82  exhibits  directly  the  errors  in 
position,  velocity,  and  attitude.  Notice  that,  in  a  north-vertical 
system,  the  same  state  variables  could  be  specified  in  terms  of  longitude 
and  latitude  errors  through  the  expressions 


6r  -  R6L 
x 

6R  ■=  RfiL 
x 

(83) 

<5R  ■  R  cos  L  5A 

y 

6*R  ■  R  cos  L  6*A  -  L  R  sin  L  <5A 

y 


where  R  is  assumed  constant.  Similar  equations  relate  the  position  and 
velocity  errors  in  a  free  azimuth  system  to  longitude  and  latitude  errors. 
However,  they  involve  resolution  through  the  angle  between  north  and 
the  system  x  axis. 
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The  equations  developed  in  Appendix  C  provide  the  l1'  matrix  lor  the 
stvtf-r  vector  of-  Kq .  B2  uhftn  nnrtli-ver  rl  onl  I’OiirdlutiLOo  ore  empluyed 
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Tlie  ayaten  matrix  when  tangent:  plane  coordinatee  are  lined  dillere  from 
that  presented  above  because  the  platioin  uxea : are  not  rented  in 
proportion  to  velocity 
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The  subscript  is  placed  on  the  abova  matrices  in  anLieipallon  of  later 
expanding  the  statu  vector  to  Include  correlated  error  terms.  The 
elements  in  Fx  include  only  the  most  significant  terms  and  the  effects 
of  position  and  velocity  along  the  vertical  axis  are  ignored.  Of  coarse, 
the  values  of  ta^,  ujy,  and  w2  will  differ  for  the  three  ".avigation  «*x!n 
systems  according  to  Eq.  78  to  80.  As  an  example  of  the  complexity  which 


can  result  when  more  terms  are  included,  tig.  2/  is  the  complete  FK 
matrix  for  north-vertical  coordinates  written  in.rernm  of  longitude, 
latitude,  and  vertical  ve'ocity  and  acceleration.  .  . 


SYSTEM  DISTURBANCES 

The  state  vector  differential  equation  is  driven  by  inertial  sersor 
errors  and  incorrect  indications  of  vertical  position  and  velocity.  Tne 
latter  errors  can  cone  from  one  or  more  of  several  instruments  whose 
consideration  is  beyond  the  scope  of  this  document.  The  effect  of  the 
errors  will  simply  be  presented. 

Vertical  position  and  velocity  errors  can  be  exhibited  by  rewriting 
Eq.  81  to  include  a  forcing  term 

x  »  Fx  +  Gu  -  .  .  (86) 


Again,  specification  of  G  and  u  permits  the  calculation  of  w  for  the 
discrete  case.  If  only  dRz  and  <$?.z  are  considered  as  driving  terms. 
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Or,  following  the  notation  and  extra  detail  of  Fig.  27,  the  C  matrix  Is 
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In  a  similar  manner,  the  effects  of  gyro  and  accelerometer  errors  can  be 
exhibited  by  defining 


uT  =  V  V  c  e  £ 
—  x  y  x  y  z 


The  error  sources  of  Eq.  87  and  90  could  be  considered  together  by 
properly  arranging  their  respective  G  matrices  into  one  matrix  expressing 
their  combined  effect  on  x.  If  the  inertial  sensor  errors  of  Eq.  90  are 
not  correlated  in  time,  no  state  vector  augmentation  is  needed.  In  terms 
of  the  state  vector  of  Eq.  82,  the  G  matrix  for  the  effects  of  Eq.  90 
Is 


0  0  0  0  0 
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In  truth,  the  inertial  sensor  errors  are  highly  correlated  quantities 
end  ere  usually  described  fcy  one  or  sere  of  the  correlation  models  given 
In  .Section  4.  It  la  therefore  necessary  to  augment  the  state  vector 
and  enlarge  the  F  matrix  accordingly.  For  example,.  if  all  inertial 
»»n*or  error  .  can  be  modeled  as  random  walk  quantities,  random  conataaLs, 
or  the  sum  of  both,  reference  to  the  preceding  section  Indicates  that 
rive  additional  state  variables  are  neetttaary .  The  augmented  state 
vector  in  given  by 
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The  new  F  matrix  is  given  by 
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where  the  suwnatrices  G  and  Fx  are  given  in  Eq.  91  and  84  or  85.  Th  ■ 
uncorrelated  disturbances  which  provide  the  random  walk  characteristic 
can  be  denoted  by 
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(94) 


and  the  new  G  matrix  is  given  by 


G'  =  I  ?- ' 


where  Ic  is  the  5x5  identity  matrix. 


(12x5) 


(95) 


*Frequently,  when  matrices  are  expressed  in  terms  of  their  sub¬ 
matrix  elements,  the  dimensions  of  the  entire  array  will  be  noted  as 
shown. 
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If  any  of  the  errors  do  not  exhibit  random  walk  behavior,  the 
corresponding,  diagonal  element  of  is  changed  to  zero.  The  random 
constant  nature  of  the  errors  is  exhibited  by  setting  the  corresponding 
diagonal  elements  of  the  initial  error  covariance  matrix,  P(t0),  equal 
to  their  mean  square  values. 


If  the  i 
vector  of  Eq. 


ensor  errors  have  exponential  .correlation  only,  the  state 
92  is  still  used  but 
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where  Fy  is  the  matrix  whose  diagonal  elements  are  composed  from  the 
quantities  8  described  In  Section  4. 
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The  vector  ju  and  Che  matrix  G  are  essentially  the  same  for  this  case. 

Many  other  combinations  of  correlated  sensor  errors  can  be  prescribed 
by  careful  adherence  to  the  rules  set  down  in  Section  4. 

When  state  vector  augmentation  takes  place  to  accommodate  correlated 
system  disturbances,  the  size  of  the  covariance  matrix  Qn  In  the  dis¬ 
crete  filter  also  increases.  If  the  quantities  forcing  the  original 
n-element  state  vector  differential  equation  are  not  uncorrelated,  the 
first  n  rows  and  columns  of  Qn  are  composed  of  zeros  while  an  appropriate 
sub matrix  in  Qft  is  the  coverisnce  of  the  uncorrelated  quantities,  u, 
described  in  Section  4,  For  the  two  examples  of  correlated  inertial 
sensor  errors  given  above, 
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(12/12) 


(98) 
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(99) 


The  discrete  forcing  vector  Wjj  is  computed  with  Eq.  9,  using  u*  as 
defined  in  Eq.  94.  The  zero  submatrix  in  the  upper  left  corner  of  Qn 
has  dimension  7x7  (the  original  state  had  seven  elements).  Other 
correlation  characteristics  for  inertial  sensor  errors  may  require  a 
larger  augmented  state  vector  and  therefore  Qn  and  matrices.  In  the 
continuous  filter  similar  behavior  occurs  In  the  matrix  product  G  Q  G^. 


MEASUREMENTS 

The  Kalman  Filter  detects  the  buildup  of  errors  in  an  inertial 
guidance  system  through  comparison  of  system  indications  with  external 
measurements.  If  the  measurement  Is  not  given  directly  in  navigation 
coordinates  it  must  be  j roperly  transformed  through  knowledge  of  the 
particular  geometry  Involved.  The  transformation  can  either  be  per¬ 
formed  outside  the  Kalman  Filter  or  take  place  in  the  measurement 
matrix,  H.  Since  direct  measurement  of  inertial  sensor  errors  is  not 
common,  the  matrices  displayed  below  are  for  the  original  7-element 
state  vector  of  Eq.  82.  Augmentation  of  the  state  tc  account  for 
correlated  random  disturbances  only  adds  an  appropriate  number  of  a 
zero  columns  on  the  right  side  of  the  matrices  shown.  It  should  be 
emphasized  that  H  relates  the  difference  between  system-indicated  and 
measured  values  to  the  system  errors. 

Position — Measurement  of  position  alone  gives  a  measurement 
matrix.  Up, 
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If  position  Bgaaereftents  are  given  in  teras  of  latitude  and  longitude 
they  can  be  cosseted  with  system  indications  of  these  quantities  and 


B 


t,  E  c:s  L 


0  0  0  0  0 


0  0  0  0  0 


C101) 


for  the  state  vector  of  Eq.  82. 

VelociLy — The  measurement  aatrix  for  velocity  measurements  Is 


[0  0  1  0  0  0  ol 
0  0  0  1  0  0  Oj 


(102) 


Attitude — For  most  attitude  measurements  the  Instrument  is  pointed 
according  to  computed  attitude  and  the  angular  deviation  of  a  preference 
point  is  measured.  As  a  result,  the  measurement  i6  of  \l>,  not  4>.  Con¬ 
sequently  not  only  attitude  errors,  but  position  errors  aa  well  are 
measured,  because 


4*  *>  <p  -  68 


<5R 


<50 


6R 

68 - 


(103) 


The  measurement  matrix  Is 


°  "R 

J  0 
0  0 


0  10  0 
0  0  10 
0  0  0  1 


(104) 
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for  the  free  azimuth  and  tangent  plane  coordinate  sys  Letas ,  For  north- 
vertical  coordinates, 


0  -  „  0  0  10  0 
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When  combinations  of  measurements  are  made,  the  measurement  matrix 
Is  constructed  by  "stacking"  the  ap  jpriate  matrices  shown  above.  For 
example,  if  position  and  velocity  are  measured  at  the  same  t ii  e 


MEASUREMENT  ERRORS 

Though  the  "measurements"  for  the  Kalman  Filter  are  actually 
differences  between  system-indicated  and  externally-measured  position, 
velocity,  and  attitude,  the  measurement  errors  are  attributed  to 
inaccuracies  in  the  external  indications  only.  As  a  result,  some 
external  measurements — such  as  position  at  a  surveyed  point--are  oftrfn 
considered  to  be  essentially  error-free.  However,  when  the  inertial 
system  is  aboard  a  moving  vehicle,  important  external  measurement  errorr 
do  arise.  These  are  specified  statistically  by  their  error  covariance 
matrices,  R.  When  the  errors  are  considered  to  be  uncorrelated  between 
measurements,  position,  velocity,  and  attitude  measurement  error 
covariance  matrices  csu  be  denoted 


-£M) 
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The  measurement  error  covariance  can  be  a  diagonal  matrix  (only  zero 
elements  off  the  diagonal).  This  indicates  no  cross-correlr r ion  between 
measurement  errors.  However,  the  measurements  must  frequently  be  taken 
in  coordinates  other  than  those  used  for  navigation,  and  cross-correlation 
between  measurement  errors  in  common.  The  measurement  instruments  acJ 
geometry  dictate  meajurewent  error  correlations,  li  several  error 
quantities  are  measured  at  the  same  time,  the  Trrcr  covariance  matrix 
R  is  constructed  from  the  appropriate  matrices  defined  above.  In  terms 
of  Lite  earlier  example  involving  stacking  measurement  matrices. 


(111) 


The  zero  submatrices  in  the  off-diagonal  position  of  Eq.  Ill  indicate 
a  lack  of  correlation  between  position  and  velocity  measurement  errors. 
If  measurement  errors  are  time— correlated,  the  state  vector  must  be 
augmented  as  described  in  Section  4  and  under  System  Disturbances 
(p.  64). 
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AN  ILLUSTRATION :  NORTH-VERTICAL  NAVIGATION 
IN  A  TACTICAL  AIRCRAFT 
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The  example  chosen  to  demonstrate  Kalman  niter  operation  comse 
directly  from  Ref.  3,  in  which  a  north-vertical  inertial  navigation 
system  is  aided  by  iuLetmilleul  position  fixes  occur  i'lg  either  two  or 
four  times  an  hour.  The  Kalman  Filter  is  employed  to  provide  optimum 
use  of  these  measurements .  Altitude  indications  are  as  a  timed  to  come 
from  an  altimeter  or  some  ocher  nonlnertlai  device  whose  errors  are 
very  email  and  therefore  not  estimated.  The  gyro  and  accelerometer 
errors  are  modeled  as  random  constants,  and  longitude  and  latitude  fix 
errors  are  assumed  to  have  exponential  autocorrelation  properties. 

The  fourteen-element  augmented  state  vector  is  given  by 


T 

x  =  I 


R6L  RcosLfix  116 L  RcmL6A  v  v  e  c  ,  c  eT  e, 

AyzxyxyziiA. 


(112) 


vhere  ej_  and  eA  are  the  latitude  and  longitude  measurement  errors.  The 
F  matrix  is  given  by 
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where  Fx  is  as  prescribed  in  Fig,  27.  The  G  matrix  has  14  rows  and 
2  columns 


(114) 
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The  measurement  matrix  has  ?.  rows  and  14  columns 


H  -  !■>  f  0 1  t2 


Qn  (or  G  Q  CT)  Is  at  14  x  14 


matrix 


C  '  0 

I 

L°  i  AJ 


(115) 


(116) 


where  A  is  the  2x2  covariance  matrix  of  white  noise  driving  the  linear 
model  for  position  error  generation. 

Tha  following  parameters  were  used  in  calculating  the  Kalman  Filter 
estimation  errors: 


BMS  initial  position  errors,  north  and  east,  ft  .  50 

Initial  velocity  error  . None 

RMS  initial  vertical  tilt,  sec  .  10 

SMS  initial  azimuth  error,  sec  .  10 

SMS  constant  gyro  drift  rate,  deg/hr  .  0.1 

IMS  accelerometer  bias  error,  yg  .  50 

RMS  uncorrelated  position  fix  errors, 

north  and  kuh t .  a, ml  . .  1 

Latitude,  deg  . .  30 

Aircraft  heading  . East 


Any  variation  of  these  parameters  is  noted  in  the  following  discussion. 

Figure  28  6hows  PMS  vehicle  position  error  time  histories.  The 
iBy>rovement  in  position  accuracy  resulting  from  taking  fixes  at  15- 
mlnute  intervale  as  opposed  to  every  half  hour  is  demonstrated.  Notice 
that  tb"  estimation  errors  (and  therefore  filter  gain)  exhibit,  an 
approximate  steady-state  behavior  after  about  2  hours. 

A  flgure-of- merit  is  defined  for  this  Kalman  Filter-aided  cruise 
inertial  navigetl w  system.  It  1b  the  square  root  of  the  time  average 
of  seen  square  position  error  after  2  hours  of  filtering.  This  figure- 
of— merit  is  plotted  in  Fig.  29  as  a  function  of  RMS  position  measure¬ 
ment  error  for  tb*  case  where  position  is  determined  every  15  minutes, 
because  latitude  error  grows  faster  between  fixes,  the  f igure-of-merit 
for  6L  is  consif.  .enf.ly  larger.  Of  course,  the  other  variables  were 
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held  constant  while  measurement  error  was  varied.  Figure  30  displays 
variation  of  the  f igure-of-inerit  as  a  function  of  vehicle  velocity. 

The  essential  insensitivity  of  position  estimate  errors  to  airspeed  is 
demonstrated.  The  f igure-of-merit  was  also  found  to  be  affected  little 
by  sizable  variations  of  vehicle  direction,  operating  latitude,  inertial 
sensor  errors,  and  platform  azimuth  alignment  error  about  the  parameters 
presented  above. 


Latitude 


Position  POM 
(  nm) 


Longitude 


Four  Fixes  per  hour 


RMS  Randon  Fix  Error  (  nm) 


FIG.  29.  Position  FOM  Versus  RMS  Random  Fix  Error. 


Initial  estimation  accuracy  is  shown  to  have  no  effect  on  the  RMS 
filter  errors  after  2  hours,  assuming  of  course  that  the  size  of  the 
initial  errors,  is  properly  reflected  in  P(tQ).  This  is  illustrated  in 
Fig.  31.  The  initial  RMS  tilt  and  azimuth  alignment  errors  are  six 
times  as  large  in  case  1  as  in  case  2.  Figure  32  demonstrates  the 
ability  of  the  Kalman  Filter  to  estimate  gyro  drift  rate,  thereby 
providing  in-flight  calibratl'em  -W>g  accuracies  shown  are  somewhat 
optimistic  because  the  drift  rate  was  assumed  constant.  A  more  realistic 
model  for  gyre  drift  rate  is  an  exponentially-correlated  error.  In 
that  case  the  drift  rate  will  be  time-varying  and  the  filter  estimation 
errors  will  approach  a  non-zero  lower  limit. 
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-—““—Four  Fixes  per  Hour 
.  —  ._._Twu  Fixes  per  Hour 
RMS  Position  Fix  Error  -  1  nm 


Position  FOM 
( nm)- 


V  elc  'ity  ( fpa) 

FIG.  30.  Position  FOM  Versus  Aircraft  Velocity. 


The  example  discussed  is  a  practical  one  and  the  figures  serve  to 
lilustrate  an  important  point:  the  error  covariance  equations  not  only 
ser  e  to  prescribe  the  Kalman  Filter  gain  matrix,  but  are  also  useful 
in  performing  consistent  analyses  of  systems  containing  the  optimum 
linear  filter.  They  can  he  used  to  determine  the  accuracy  changes  that 
will  result  If  Inertial  sensor3  or  measurement  devices  are  altered. 

The  resulting  trade-offs  are  specified  in  terms  useful  i-u  the  syotem 
designer. 


FIG.  31.  Effect  of  Initial  Conditions. 
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FIG.  32.  Time  History  of  RMS  Errors  in  the  Estimate 
of  Constant  Drift  Rate. 


J?,lfl^jiilJ,fl]6i|(lBtrnitl^i6rtUi|j^VnirffJlB]i^^^ff!Hfll^lRt?lllT|^,^rB(rnii  1^,l'•15d11|l^,^(!^^1fllB1^,  1,1,1  •ntprafTr'iifi ISII If iTiistnnt* III^I pn t .i(ir7ip4»<tn  -r-r*  +vr,,-  ••>  in. . .  a. o#,i ~  _ _  _ -no-tn'imiit'iTi'iirt'iiiiiiriininnii'^iiiii'iifniiii JinjmBiiiiRiiiiniiitt 


me  TP  4652 


Section  6.  CORRECTIONS  OF  INERTIAL  NAVIGATION 
SYSTEM  ERRORS 


At  this  point  all  the  operations  necessary  to  provide  Kalman 
Filter  estimates  of  the  errors  in.  inertial  navigation  systems  have  been 
presented*  This  chapter  discusses  two  general  schemes  using  these 
estimates  to  Improve  system  accuracy.  Emphasis  will  be  placed  on  the 
technique  *.rhich  corrects  errors  within  the  system  directly. 


CORRECTION  OF  NAVIGATION  SYSTEM  OUTPUT 

Because  navigation  system  outputs  such  as  position,  velocity,  and 
heading  are  the  principal  quantities  of  interest,  the  most  apparent  use 
of  error  estimates  is  to  apply  them  as  corrections  to  the  system  output 
(feedforward  technique).  Figure  33  illustrates  this  scheme.  The  feed¬ 
forward  approach  has  minimum  complexity  because  only  the  quantities  of 
interest  are  corrected.  However,  the  linear  error  dynamics  of  inertial 
guidance  systems  actually  result  from  a  linearization  of  error  behavior. 

It  is  conceivable  that,  if  corrections  were  only  applied  to  the  Bystem 
output  and  internal  system  errors  were  allowed  to  grow,  the  lineariza¬ 
tion  would  no  longer  be  valid.  In  addition,  some  inertial  navigation 
systems  are  so  constructed  that  their  outputs  are  directly  connnected 
to  other,  dependent  systems,  precluding  the  use  of  feedforward  correction. 
These  considerations  have  led  to  the  frequent  use  of  a  different  scheme 
for  employing  system  error  estimates. 


FIG.  33.  Illustration  of  Feedforward 
Correction  of  System  Output. 
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DIRECT  REMOVAL  OF  NAVIGATION  SYSTEM  ERRORS 

At;  alternate  technique  for  the  application  of  the  system  error 
estimates  is  to  use  them  to  change  the  state  variables  within  the 
inertial  navigator  (feedback  configuration).  Figure  34  illustrates  this 
approach.  The  quantities  to  be  changed  can  all  be  represented  as  outputs 
of  different  integrators  (or  gumming  processes  in  a  digital  computer). 
This  is  a  consequence  of  writing  the  state  variable  behavior  in  the 
form  of  a  first-order  differential  equation.  If  all  the  system  errors 
are  corrected,  the  quantities  of  interest  (position,  velocity,  etc.) 
will  always  have  their  "best"  values.  The  use  of  this  technique  usually 
involves  three  distinct  forma  of  control  or  error  removal  which  differ 
because  the  integrators  mentioned  above  may  be  of  different  types  and 
may  or  may  not  be  accessible.  In  the  following  discussion  the  assumption 
Is  made  that  discrete  measurements  are  being  used.  Extension  to  the 
use  of  continuous  error  estimates  Is  straightforward. 


FIG.  34.  Illustration  of  Feedback  Correction 
of  Navigation  System  Errors. 

Reset  or  Impulsive  Control 

When  the  quantity  whose  error. is  to  be  corrected  is  an  electrical 
signal  ac  the  output  of  an  integrator  (or  in  the  memory  of  a  digital 
computer),  it  can  be  changed  immediately.  The  resetting  of  this  value 
can  be  viewed  as  the  application  of  an  impulse  of  proper  size  to  the 
Integrator  input,  hence  the  expression  "impulsive  control."  Impulsive 
correction  minimizes  the  system  errors  for  all  times  between  measure¬ 
ments  (Ref.  27).  Typical  of  the  variables  subject  to  this  control  are 
position  and  velocity,  as  well  as  attitude  when  it  is  represented  by  a 
direction  cosine  matrix. 
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Continuous  Correction 

Not  all  of  the  system  state  errors  estimated  by  the  Kalman  Filter 
can  be  rapidly  corrected.  It  will  be  recalled  that  it  is  usually 
necessary  to  estimate  correlatad  system  disturbances  and  measurement 
errors.  In  so  doing,  the  new  state  variables  are  often  represented  as 
outputs  of  fictitious  linear  systems.  However,  the  integrator  inputs 
of  these  systems  cannot  be  reached.  Thus,  the  Kalman  Filter  output 
cannot  be  applied  as  an  impulsive  correction.  For  example,  consider  the 
sum  of  a  constant  and  an  exponentially-correlated  gyro  drift  rate.  The 
system  error  estimates  (estimates  of  gyro  drift  rate  components)  can 
only  be  applied  as  corrections  at  the  gyro  output,  or  equivalently  as  a 
torque  with  known  effect  on  the  output-.  Figure  35  illustrates  this  case. 

Mtrr  RATK  MODEL 


FIG.  35.  Illustration  of  the  Feedback  Correction 
of  a  Typical  Gyro  Drift  Rate  Model. 
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The  correction  for  the  constant  drift  rate  Is  an  obvious  one— - 
effectively  subtract  the  estimate  of  this  quantity  from  the  gyro  output. 
The  correction  for  the  exponentially-eoriralateJ  error  is  not  as  apparent; 
it  follows  from  the  difference  in  gyro  error  which  would  occur  if  the 
integrator  were  accessible.  The  correction  for  all  time  after  tn  is 
than  given  in  terns  of  che  estimate  of  this  error  at  tn  bv 


.  i 


corr, 


*2„  e 


-B(t-tn) 


(117) 


Notice  that  Xcoro  is  the  Kalman  Filter  estimate  of  X2(t)  when  no 
correction  is  applied.  Therefore,  by  subtracting  this  value  the  estimate 
of  X2  is  made  zero. 

The  gyro  errors  in  this  example  and  the  corrections  applied  based 
on  Kalman  Filter  estimates  are  illustrated  in  Fig.  36.  Similar  argu¬ 
ments  can  be  used  to  prescribe  the  continuous  corrections  necessary  for 
other  forms  of  correlated  system  errors  and  disturbances.  It  should  be 
emphasized  that,  when  subsequent  measurements  produce  additional  error 
estimates,  the  corrections  based  on  these  new  errors  are  added  to  those 
already  being  applied. 
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FIG.  36.  Illustration  of  the  Feedback 
Correction  of  Constant  anu  Exponentially- 
Correlated  Gyro  Drift  Rate. 
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FILTER  EQUATION  SIMPLIFICATIOK 
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Or.e  important  result  of  applying  error  estimates  directly  to 
remove  system  errors  is  that  this  provides  a  siaplif ication  of  the 
Kalman  Filter  equations.  Equation  20  can  be  written  as 


x  .«.  ♦  _S 
— p+1  n  — n 


Kn+1  ^n+1 


-H  x 
n+1  n— n 


(118) 


Since  the  feedback  scheme  causes 

S  -  0  (U9> 

— n 


immediately  after  the  measurements  are  made,  the  next  estimate  of  the 
system  errors  is  given  from  Eq.  118  by 


^n+1 


K  ,  z  . 
n+1  —n+1 


(1/0) 


It  should  be  remembered  that  the  quantity  in  Eq.  120  is  composed 

from  the  difference  between  the  actual  measurements  and  those  Indicated 
by  the  inertial  syscem  output  variables.  This  simplification  eliminates 
the  need  to  compute  fl’nXn  and  The  matrices  $n  and  Hn+y  are, 

however,  stiil  required  for  the  calculation  of  Kn+x- 
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Section  7.  APPLICATION  TO  CYROCOMPASSINC- 


Prior  to  the  use  oi  Kalman  Filters  in  inertial  navigation  systems , 
platform  alignment  ami  the  removal  of  cruise  system  errors  were  usually 
considered  separately.  In  order  to  selC-align  the  Inertial  navigator, 
certain  additional  electrical  connections  were  made  wiLhin  the  system 
which  provided  additional  platform  rotation  coraaands.  These  techniques 
suffered  boss  of  the  shortcomings  discussed  in  Section  1  for  cruise 
error  reduction- -they  used  stationary  fiiters  and  did  not  aeeount  for 
time-varying  inertial  censor  and  measurement  errors.  If  the  Kalman 
Filter  ia  provided  for  estimating  cruise  system  errors,  it  is  easily 
employed  to  aid  platform  alignment  as  well.  The  term  gyrocompassiug, 
originally  used  to  describe  the  tracking  of  both  gravity  and  the  hori¬ 
zontal  component  of  earth  rate  by  self-aligning  inertial  systems,  is 
frequently  applied  to  all  schemes  for  self-alignment,  including  use  cr 
the  Kalman  Filter. 

The  filtering  approach  permits  estimation  of  the  system  errors 
until  they  are  determined  to  within  a  prescribed  accuracy,  followed  by 
a  rapid  error-correction  process.  Consequently,  the  Schuler  loop 
characteristic  of  locally-level  systems  la  not  destroyed  during  the 
alignment  procedure  and  the  inertial  platform  errors  are  not  affected 
by  vehicular  motion.  (The  conventional  gyrocompass lng  ground  alignment 
approach  is  demonstrated  in  Ref.  28.)  The  alignment  of  strapdown  systems 
is  analogous  to  that  of  piatform  systems  even  though  corrections  are 
applied  to  the  direction  cosiue  matrix  instead  of  rotating  the  instru¬ 
ment  cluster. 


FIXED-POSITION  GYROCOMPASSING  ALIGNMENT 

When  the  carrying  vehicle  is  not  moving  relative  to  the  earth, 
position  information  is  usually  known  with  such  accuracy  that  it  can 
be  considered  error-free.  In  addition,  any  velocity  indications  in  the 
inertial  system  can  be  taken  as  errors  and  used  for  direct  inputs  to 
the  Kalman  Filter.  If  attitude  references  are  available,  they  can  also 
be  employed  to  aid  in  system  alignment.  If  vehicle  position  is  well 
known,  measurement  errors  in  position  and  velocity  can  only  be  generated 
by  vibrations  in  the  carrying  vehicle.  The  desire  to  align  rapidly, 
combined  with  a  situation  where  only  small  measurement  errors  with  short- 
period  correlations  exist,  provides  three  basic  altirnatives  for  fi  *d- 
poBition  alignment  with  the  Kalman  Filter. 

One  approach  is  to  effect  continuous  filtering  (Ref.  29).  In  this 
case,  as  a  result  of  the  continuous  approach,  velocity  and  position 
measurement  error  time  correlations  become  significant  and  the  state 
vector  must  be  augmented  to  account  for  them.  This  necessitates  uxing 
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a  considerably  modified  and  more  complex  vertien  of  the  Kalman  Filter 

than  la  necessary  for  cruise  error  estimation.  Aa  alternate  scheme. 

which  is  More  compatible  with  rht>  equipment  necessary  for  cruise  Inertial 

system  augmentation,  is  to  use  the  discrete  version  of  the  Kalman  Filter, 

employing  measurements  at  intervals  larger  than  toe  short  correlation 

tiffle  of  the  measurement  errors.  As  a  result,  the  errors  In  measurements 

can  be  assumed  uncorrelated  and  the  Kalman  Filter  equations  of  Section  2  ■ 

can  be  used.  -A  third- approach,- used  in  the  following  section.  Is  to 

consider  the  measurement  noise  a«  unc-orrelated  because  its  correlation  .  :  f 

period  is  small  relative  to  system  characteristics.  This  permits  con-  ’ 

tinuoue  filtering  with  fuve~  state  variables,  but  may  not  be  as  accurate  i 

as  the  first  technique.  Tire  second  approach  is  discussed  below  because 

it  follows  closely  ti«e  ideas  clready  presented. 

Briefly,  when  north-vertical  navigation  coordinates  are  considered 
for  a  vehicle  which  is  essentially  motionless  relative  to  the  earth,  the 
state  vector  can  be  defined  by  Eq,  82  and  the  ':y  matrix  of  Eq.  8 U 
specialises  to 
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If  the  measurement  errors  are  assumed  uucorrelated,  state  vector  aug¬ 
mentation  is  entirely  due  to  inertial  sensor  errors.  In  addition;  over 
the  short  estimation  period  of  alignment  these  can  be  approximated  as 
the  sums  of  constants  and  random  walk  quantities.  If  the  estimation 
period  is  very  short.,  representation  by  random  constants  may  suffice. 

In  either  case  Fu  is  zero.  The  F  matrix  for  the  augmented  state,  Eq.  S2, 
is  given  bp 
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If  random  walk  h&havlor  is  included  in  the  models  of  all  inertJal 
sensor  errors,  the  matrix  G  Q  gT  is 
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where  Qy  is  the  covariance  matrix  for  the  vector  of  uncorrelated  inputs 
to  the  random-aalk-genera ting  integrators.  $n  can  be  approximated  for 
the  short  intervals  between  measurements  by 
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The  matrix  Qn  in  the  error  covariance  equation  i.s  given  in  terms  of  a 
5x5  matrix  Ln  an 
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If  only  constant  inertial  sensor  errors  are  considered,  GQGT  ~.nd  Qn  are 
zero.  In  any  case,  the  mean  square  values  of  the  random  constants 
appear  in  the  diagonal  elements  of  the  lcwer  right  5x5  submatrix  of 
the  Initial  error  covariance,  P{tQ). 
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If  velocity  and  position  measurements  are  used  and  position 
difference  is  assumed  to  contain  no  errors,  the  matrix  R  is 


R  = 


0 

0 

0 

0 


(127) 


where  a2^x  is  the  mean  square  indicated  vehicle  velocity  caused  by 
vibration.  Velocity  errors  are  assumed  uncorrelated  in  Eq.  127.  The 
measurement  matrix,  11^  ^  is  given  in  Eq.  106. 

All  of  the  matrices  necessary  for  claculating  the  error  covariance 
and  filter  gain  as  functions  of  time  have  been  prescribed.  If  the 
disturbances  and  measurement  noice  are  stationary  or  their  time  behavior 
is  known  beforehand,  the  filter  gain  matrix  can  be  precomputed  and  stored. 
If  they  are  stationary,  the  gain  will  reach  a  unique  steady  state. 

Some  suboptimal  filter  possibilities  are  discussed  in  Section  9  for 
similar  cases. 


MOVING  VEHICLE  GYROCOMPASSING  ALIGNMENT 

The  self-alignment  of  inertial  navigation  systems  in  moving  vehicles 
Is  computationally  similar  to  fixed-position  gyrocompassing.  Velocity 
and  position  differences  again  provide  the  Kalman  Filter  Inputs. 

However,  sizable  measurement  errors  are  common  in  the  case  of  moving 
vehicle  alignment.  Position  measurements  are  typically  provided  by 
Tacan,  Loran,  or  Omega  radio  navigation  aids.  Velocity  can  be  measured 
by  Doppler  radar  in  an  aJ.r<nwi f.t  or  by  a  ship’s  spaed  log.  Because 
velocity  indications  are  usually  given  in  vehicle  coordinates,  an 
independent  heading  reference  is  needed  to  resolve  them  into  navigation 
coordinates.  Any  azimuth  errors  in  this  device  wilJ  be  transferred  to 
the  inertial  system.  In  addition,  position  and  velocity  must  be  estimated 
in  the  moving  vehicle  case. 

For  example,  consider  the  airborne  alignment  of  an  inertial  naviga¬ 
tion  system  with  the  aid  of  Doppler  velocity  indication  and  intermittent 
position  fixes.  It  can  be  shown  that  the  correlated  measurement  errors 
appearing  in  Doppler  indications  of  velocity  can  be  removed  by  pre¬ 
filtering  for  a  period  of  30  to  60  seconds  (Ref.  2).  The  prefilter  output 
(Input  to  the  Kalman  Filter)  contains  uncorrelated  errors  and  a  small 
bias  error  which  is  ignored  in  the  following  discussion.  The  system 
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matrix,  Fx,  is  no  longer  constant.  It  is  prescribed  by  Eq.  84  (or  85) 
with  'jJjj,  to  ,  toz  computed  according  to  Eq.  78,  79,  or  80,  depending  on 
the  navigation  coordinate  frame.  If  no  augmentation  of  the  state  vector 
results  from  correlated  position  or  velocity  measurements,  the  F  and 
GQG^  matrices  follow  the  form  prescribed  in  Eq.  122  and  123.  The 
matrices  $n  and  Qn  also  are  similar  to  those  outlined  in  the  preceeding 
section. 

The  measurement  noise  matrix  is  nonsingular.  If  the  position  fix 
errors  are  not  cross-correlated,  the  R  matrix  will  be 
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2 

where  a6Rx  is  the  mean  square  error  in  position  fix  along  the  x  axis,  etc. 
The  matrix  Ry  describes  the  velocity  measurement  error  covariance. 

Because  Doppler  velocity  errors  along  and  across  the  aircraft  track 
differ  and  usually  appear  in  both  north  and  east  velocity  measurements, 

Ry  is  not  commonly  a  diagonal  matrix.  If  along-  and  cross- track  Doppler 
errors  are  assumed  not  correlated  with  each  other  and  given  by  the 
vector 


(129) 


the  velocity  errors  resolved  into  north  and  east  components  are  given 
by  Vy 
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The  Ry  matrix  is  then  dependent  on  the  heading  angle  a 

R  =  cov  [  v',  v'  J 
v  —v  —v 


0a  cos’  a 
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+a5v  sin3  a 
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a  c 
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a  vc 
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The  fact  that  R  is  a  function  of  vehicle  heading  imposes  a  restriction 
on  the  vehicle  flight  path  when  precomputation  of  the  filter  gain  matrix 
is  desired,  The  measurement  matrix  HpjV  is  similar  to  the  one  described 
in  the  previous  section. 

A  comparison  of  Kalman  Filter  accuracy  and  the  RMS  errors  that 
result  from  a  fixed-gain  alignment  technique  is  shown  in  Fig.  37,  33, 
and  39  for  this  example.  The  important  parameters  used  in  arriving  at 
these  figures  are: 


RMS  initial  tilt  angles,  mrad  . .  2 

RMS  initial  azimuth  error,  mrad  .  10 

RMS  constant  accelerometer  errors,  £  10“4 

RMS  constant  gyro  drift  rates,  deg/hr  .  0.01 

RMS  Doppler  bias  error.  £t/sec 

Cross-track  . 3.0 

Along- track  .  2.0 

RMS  Doppler  errors  with  1-sec.  correlation  time 

(along-  and  across-track) ,  ft/sec  . 3 

RMS  uncorrelated  Doppler  errors  at  the  end  of  a 
30-sec  prefiltering,  ft/scc 

Cross-track  .  1.0 

Along-track  . 0.75 

RMS  uncorrelated  position  fix  error,  ft 

North-south  .  600 

East-west  .  600 

Vehicle  velocity  (due  east),  ft/sec  . 800 
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FIG,  37.  Optimal  Versus  Conventional  Airborne  Erection  Accuracy. 


FIG.  38.  Optimal  Versus  Conventional  Airborne  Alignment  Accuracy 


FIG.  39.  Optimal-  Versus  Conventional  Airborne  Alignment  Accuracy. 


The  Kalman  Filter  exhibts  a  distinct  accuracy  advantage  in  estimating 
attitude  error:;  (Fig.  37  and  39)  regardless  cf  the  time  interval  between 
position  fixes.  This  follows  from  the  fact  that  velocity  errors  contain 
considerable  information  about  bystem  misorientation  while  position  errors, 
though  contributing  some  additional  accuracy,  are  less  useful.  The 
similarity  of  Fig.  39  to  Fig.  5  results  from  the  fact  that  they  describe 
situations  which  are  almost  identical.  The  Kalman  Filter  also  provides 
more  exact  estimates  of  position  than  the  fixed-gain  filter  (see  Fig.  38). 
The  better  accuracy  of  the  Kalman  Filter  in  estimating  all  three 
quantities  results  from  its  time-varying  nature  and  the  fact  that  it 
considers  time-varying  inertial  sensor  errors.  The  fixed-gain  filter 
errors  approach  those  of  the  Kalman  Filter  in  r.he  steady  state  but  the 
ability  of  the  latter  to  provide  faster  alignment  is  well  documented  in 
the  figures. 


ISTtTTm 55T - 


When  the  gyros  and  accelerometers  have  not  been  running  for  a  con¬ 
siderable  time  before  the  start  of  filtering,  their  internal  temperatures 
will  sot  have  been  stabilized.  To  the  extent  that  they  can  be  determined, 
the  temperature-caused  error?  can  be  subtracted  from  the  sensor  error 
models.  If  these  effects  can  be  accurately  established,  the  Kalman  Filter 
airborne  alignment  can  be  performed  with  an  inertial  system  as  it  is 
being  warmed  up. 
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Section  8.  APPLICATION  TO  ALIGNMENT  TRANSFER 


The  Kalman  Filter  is  a  useful  tool  for  the  transfer  alignment  of 
one  inertial  system  to  another.  The  problem  is  essentially  one  of 
accurately  estimating  misalignment.  Cnee  the  misorientation  is  detected, 
removing  the  errors  is  not  difficult.  While  transfer  alignment  of  a 
weapon  inertial  reference  system  from  a  "master" -system  imposes  all  the 
errors  of  the  master  on  the  "slave",  this  situation  may  often  be  preferred 
to  that  of  aligning  the  slave  to  an  "ideal"  coordinate  frAne.  Before 
filtering,  the  two  systems  are  first  brought  into  near  alignment  by  some 
knowledge  of  their  relative  orientation.  This  is  usually,  accomplished 
without  difficulty  because  they  are  connected  by  a  physical  structure  ar. 
the  time  of  alignment.  The  residual  raisorientation  caueed  by  uncertainties 
in  mounting  and  structural  flexure  is  small  and  permits  linearisation  of 
the  equations  describing  alignment  errors. 

The  alignment  transfer  technique  employing  the  Kalman  Filter  is 
basically  an  extension  of  vector  matching.  The  vectors  employed  are 
motions  which  can  be  measured  by  inertial  sensors,  such  as  linear  accel¬ 
eration  and  velocity  or  angular  rate  and  displacement.  Matching  of 
vectors  which  are  measured  by  inertial  components  already  available 
eliminates  the  necessity  for  elaborate  additional  equipment  to  perforo 
alignment,  although  a  computer  is  required  to  process  the  measurements. 

Transfer  alignment  using  the  Kalman  Filter  is  accomplished  by 
measuring  the  same  vector  in  the  tve  nearly-aligned  coordinate  systems 
and  using  the  difference  as  the  filter  input.  A  good  discussion  of  the 
principles  involved  in  determining  the  relative  alignment  of  orthogonal 
coordinate  frames  by  vector  matching  can  be  found  in  Ref.  30.  It  is 
well  known  that  the  relative  orientation  of  two  axis  systems  cannot  be 
determined  uniquely  by  measuring  a  single  vector.  Two  noncolinear  vectors 
are  needed,  and  for  fixed  measurement  accuracies,  two  vectors  at  right 
angles  are  preferred.  An  example  of  alignment  using  two  noncolinear 
vectors  is  the  conventional  gyrocompassing  of  an  Inertial  system;  the 
two  vectors,  with  known  orientation  in  the  reference  coordinate  frame, 
are  gravity  and  earth  rate.  The  useful  portion  of  earth  rate  is  that 
part  normal  to  gravity.  At  the  poles,  where  the  two  vectors  are  parallel 
this  technique  becomes  useless.  Away  from  the  poles  the  gyrocompassing 
system  detects  the  two  vectors  and  their  misalignment  with  the  platform 
axes,  reorienting  the  platform  until  it  is  properly  aligned.  The  gyro¬ 
compassing  example  also  serves  to  illustrate  Che  fact  that  transfer 
alignment  is  not  restricted  to  the  use  of  a  reference  Inertial  system. 

Any  set  of  axes  In  which  the  necessary  vectors  can  be  measured  will 
serve  as  the  toaster  coordinate  frame. 
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GIHBALLED  SYSTEM  TRANSFER  ALlOftffiNT 

Transfer  alignment  between  two  gitaballed  pin*-,  forms  consists  of 
accurate  estimation  of  the  misalignment  and  subsequent  rotation  of  the 
slave  platform  to  bring  its  axes  into  coincidence  with  the  master  frame. 
This  rotation  can  be  accomplished  with  great  precision.  Therefore, 
though  the  correction  of  slave  attitude  could  he  accomplished  during — 
estimation.  It  would  serve  to  increase  the  filter  computations  without 
increasing  accuracy.  Attitude  correction  is  not  required  to  preserve 
the  linearity  of  the  differential  equations  for  alignment  errors. 

Coarse  alignment  to  within  a  degree  or  two  1b  accomplished  by 
matching  corresponding  glmbal  angles  of  the  two  systems.  Consider  the 
north-vertical  coordinates  described  in  Section  3;  because  no  disturb¬ 
ance  of  the  normal  operation  of  both  systems  occurs  during  estimation, 
the  Schuler  tuning  characteristic  of  these  systems  is  unaltered. 

Previously  proposed  leveling  schemes  based  on  vector  matching  destroyed 
the  Schuler  characteristic,  creating  new  alignment  errors  (see  Ref.  31). 
Because  both  platforms  are  isolated  from  vehicle  angular  motion  during 
the  estimation  process,  structural  flexure  only  provides  ar  Initial 
condition  on  the  error  statistics  of  the  misalignment.  Initial  conditions 
for  longitude  and  latitude  are  provided  to  the  slave  from  the  master 
system  after  completion  of  alignment.  The  ideas  outlined  in  the  balance 
of  rhls  section  are  a  summary  of  work  reported  in  Ref.  12. 

After  the  slave  system  is  given  initial  values  of  east  velocity  and 
north  velocity  from  the  master  system,  both  platforms  are  operated  in 
their  normal  nudes  while  filtering  Is  conducted.  Earth  rate  commands 
to  the  gyros  are  identical  and  originate  from  the  master  system.  Two 
or  three  of  the  velocity  Indications  of  the  systems  are  compared  and  the 
differences  are  used  as  inputs  to  the  Kalman  Filter.  Velocity  differ¬ 
ences  due  to  the  physical  separation  of  the  two  systems  are  removed 
from  these  signals  prior  to  their  entrance  into  the  filter.  The 
differential  equations  for  the  velocity  differences,  5fc,  and  small  mis¬ 
alignment  angles,  between  the  two  nearly  aligned  glmballed  systems 
can  be  written  in  the  form  of  Eq.  2  where 
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G  is  the  identity  Matrix  and  u  it,  the  vector  of  difierencge  between 
scr.Hlern®ft?r  errors  V  and  gyro  errors  c 


u1- 


,K  -vx  -*K  h«  -<v  h<_  n  (u3> 

!_  xm  xs  yra  ys  m  Xs  yra  ys  2m 


The  measurement  matrix  II  is  given  by 


H 


0  0  0 
2  0  0 


0 

0 

0 


(134) 


If  only  north  and  east  velocities  are  being  compared,  the  third  reus 
and  columns  of  Fx  and  it  are  deleted  and  V2  is  dropped  from  _u.  The  non- 
colinear  vector  is  provided  by  maneuvering  the  vehicle,  thereby  creating 
an  acceleration  vector  with  time-varying  orientation  relative  to  tba 
master  coordinates.  The  continuous  version  of  the  Kalman  filter  is  used 
and  an  infinity  of  noncolinear  vector  pairs  results  from  the  vehicle 
maneuvers. 

Accelerometer  errors,  V,  and  gyro  drift  rates,  L,  are  represented 
by  the  sum  of  a  random  constant  and  a  random  walk.  Tills  description  of 
luei'Liai  sensor  errors  augments  the  state  vector  with  one  additional 
variable  for  each  aensor  considered,  thereby  doubling  the  dimension  of 
the  problem.  However,  through  familiarity  with  the  importance  of 
various  effects,  the  state  vector  can  be  reduced  (Ref.  12).  In 
particular,  the  Schuler  period  and  gyro  drift  rate  are  observed  to  have 
no  significance  for  the  problem  considered  there,  due  to  the  short  time 
of  observation. 


Inspection  of  the  F  matrix  for  this  problem  and  knowledge  of  its 
appearance  in  the  differential  equation  for  the  error  covariance  matrix 
(Eq.  29)  indicates  that  the  accuracy  of  the  Kalman  Filter  can  be 
influenced  by  vehicle  maneuvers  through  the  accelerations  a*,  ay,  and 
az.  When  vertical  velocity  is  not  available  for  comparison  and  the 
vehicle  is  restricted  to  horizontal  maneuvers,  the  sum  of  the  mean 
square  errors  in  the  estimates  of  <pXt  $y,  and  (J>z  is  minimized  by  rotating 
the  acceleration  vector  at  its  maximum  rate  (Ref.  12).  For  an  aircraft, 
this  implies  a  maximum  rate  turn  at  constant  speed.  In  addition, 
because  in  the  absence  of  vertical  acceleration  the  measurements  6rx 
and  (fay  cannot  distinguish  between  constant  accelerometer  error  and 
platform  tilt,  the  accuracy  of  the  filter  in  estimating  <f>x  and  <py  is 
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directly  Halted  by  the  size  of  the  x  and  y  axis  accelerometer  biases. 

This  serves  to  demonstrate  one  aspect  of  the  observability  problem 
discussed  in  Section  '  ' 

If  all  three  velocity  differences  are  available  as  inputs  to  the 
filter,  the  aircraft  optimum  horizontal  maneuver  is  still  the  tightest 
turn  permissible.  In  this  case,  the  constraint  between  tilt  angle 
estimation  accuracy  and  constant  accelerometer  errors  is  removed 
because  the  additional  measurement,  6KZ,  also  contains  indications  of 
and  $y  which  are  distinguishable  from  the  constant  portions  of  Vx 
and  Vy .  Consequently,  estimates  of  the  constant  errors  In  the  x  and  y 
accelerometers  have  greater  accuracy.  Similar  improvements  result  when 
only  horizontal  velocities  are  compared  but  vertical  maneuvers  are 
performed.  Inspection  of  the  F  matrix  reveals  that  vertical  maneuvers, 
by  creating  a  time-varying  az,  provide  a  means  of  distinguishing  between 
level  misalignment  (time-varying  coefficient)  and  constant  accelerometer 
errors. 

Measurement  noise,  as  mentioned  earlier,  can  be  generated  by  relative 
velocities  between  systems  caused  by  structural  flexure.  In  addition, 
some  quantization  and  signal  transmission  noise  may  be  significant. 

While  the  noise  present  in  the  velocity  signals  of  either  inertial 
reference  system  is  typically  a  very  small  fraction  of  the  true  signal, 
errors  in  the  velocity  difference  can  have  significant  relative  magnitude. 

The  use  of  the  continuous  version  of  the  Kalman  Filter  and  the  size 
of  the  state  vector  generate  a  considerable  computer  load  if  all  calcula¬ 
tions  are  performed  on-line.  Precomputed  gains,  stored  as  functions  of 
time  and  vehicle  heading,  can  reduce  this  problem  considerably.  However, 
Cue  vehicle  Carrying  the  CwC>  giiuh^lleu  lueilidl  systems  wuulu  have  to 
perform  preplanned  maneuvers.  This  can  be  a  tactical  problem,  but 
typical  alignment  times  are  on  the  order  of  a  minute  or  less. 

The  ability  of  the  continuous  Kalman  Filter  to  provide  quick,  accurate 
estimates  of  the  misalignment  between  two  gimballed  inertial  systems  is 
illustrated  by  Fig.  AO  and  41.  They  show  time  histories  of  the  RMS  errors 
in  Kalman  Filter  estimates  of  level  and  azimuth  misalignment  when  only 
horizontal  velocities  are  compared.  The  errors  were  found  by  solving 
the  error  covariance  differential  equation  (Eq.  29)  with  following 
Inputs: 

Vehicle  maneuver  .  >£  horizontal  turn 

Vehicle  velocity,  ft/sec  . . . . . . .  l()3 

Measurement  noise  .  1.5  ft/sec  KMS  from  each  system; 

flat  power  spectral  density  to 
1,000  cps  (see  Appendix  A) 

RMS  gyro  drift  rate,  deg/hr  .  0.25 

RKS  constant  accelerometer  error,  £  . .  10“^ 
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FIG.  AO.  RMS  Azimuth  Misalignment  Estimation  Errr ( 
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'Ref.  IJ). 


FIG.  41.  Comparison  of  RMS  Level  Misalignment  Estimation  Errors 
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The  two  figures  indicate  tiiat  at  the  end  of  a  15— second  estimation 
period  the  azimuth  mlsallgrroent  is  knnwn  much  acre  accurately  than  level 
misaligDsent.  It  can  be  sees  that  the  estiBation  errors  for  the  level 
angle  have  reached  a  steady-state  value  of  milliradians.  This  cor¬ 
responds  to  the  lover  limit  imposed  by  the  constant  accelerometer  errors. 
The  factor  of  yf2~ results  from  adding  the  m&.n  square  accelerometer 
errors  from  corresponding  sensors  in  the  two  systems.  Of  course,  com¬ 
parison  of  vertical  velocities  or  performing  a  ertical  maneuver  will 
remove  this  constraint.  It  can  be  seen  that  the  Kalman  Filter  holds 
considerable  promise  as  a  wans  of  measuring  the  misalignment  between 
two  giraballed  inertial  guidance  systems. 


STRAP DO UN  TO  G1MBALLEJ)  SYSTEM  TRANSFER  ALIGNMENT 

Alignment  between  a  stabilized  gimballed  inertial  reference  system 
and  a  a  trapdown  inertial  system  involves  accurate  determination  of  the 
transformation  matrix  relating  the  two  coordinate  frames.  The  initial 
coarse  alignment  is  determined  by  calculating  the  transformation  matrix 
from  gimbal  angles.  For  reasons  similar  to  those  discussed  in  the  pre¬ 
vious  section,  more  accurate  determination  of  the  relative  orientation 
is  necessary. 

Three  variables  are  ceeded  to  describe  the  relative  orientation 
between  two  sets  of  three  orthogonal  axes.  However,  in  the  str;  pdown 
application  it  is  necessary  to  compute  changes  in  orientation  based  on 
angular  rates  measured  by  the  system  gyros.  In  this  case  the  differential 
equations  far  Che  Euler  Angles  contain  a  singularity  corresponding  to 
gimbal  lock  in  a  stabilized  platform.  For  general  angular  motion,  at 
least  four  parameters  (analogous  to  four  gimbals)  are  needed.  It  also 
is  possible  to  compute  all  nine  elements  or  direction  cosines  of  the 
transformation  matrix  directly. 

Though  more  variables  are  involved,  the  direction  cosine  calcula¬ 
tions  are  linear.  The  differential  equations  for  three-  or  four-parameter 
representations  of  rotation  are  highly  nonlinear.  Reference  32  provides 
a  tore  complete  discussion  of  transformation  matrices.  When  the  Kalman 
Filter  is  to  be  used,  linearity  of  the  original  equations  avoids  potential 
errors  that  can  result  from  linearization  about  a  nominal  trajectory. 

Zf  the  linearization  is  performed  perfectly,  no  one  set  of  parameters 
offers  an  estimation  accuracy  advantage  over  the  others  (Ref.  12). 

However,  only  calculation  of  the  nine  direction  cosines  will  be  con¬ 
sidered  below. 
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The  true  direction  cosine  matrix.  0.  relates  an  acceleration  vector 
measured  in  platform  coordinates,  Tp,  Lu  the  seme  vector  resolved  in 
vehicle  or  strapdown  coordinates,  lv,  according  to 


The  ot.hogonality  of  the  transformation  dicates  that  the  inverse  of  C  is 
also  its  transpose,  simplifying  calculation  of  the  relation  C-1  con¬ 
siderably.  The  linear  differential  equation  for  C,  in  terms  of  Che 
angular  rate  of  the  strapdown  system  expressed  In  vehicle  coordinates , 
is  given  by 


C  -  CT. 


where  the  matrix  12  is  constructed  from  the  vehicle  angular  rates  lUy, 
and  according  to 


J*  0  uj 


l_  -U) 

Z  y 


Q  «  |  -w 


wy  “UJx  0 


An  initial  error  exists  ir.  knowledge  of  the  C  matrix.  The  matrix 
in  the  computer 


Cc  -  C  +  6C 


is  the  sum  of  the  true  matrix  and  a  small  difference  which  obeys 
differential  equation  analogous  to  Eq.  136 


6C  =  6C  12 


The  platform  accelerometer  triau  indicates  the  true  acceleration  vector 
3p  plus  accelerometer  errors  ^p.  The  strapdown  sensors  provide  the  sum 
of  CT3_  and  an  error  vector  Vv.  The  difference  between  the  strapdown 
measurement  transformed  by  Cc  and  the  platform  indication  is 

S  -  (6C)  cTlp  +  ctfv  -  Sp  (140) 

where  the  term  5d?v  has  been  considered  a  higher-order  effect  and 
ignored.  Defining  a  new  3-element  vector,  d,  by 


d  =  A 

d  (to)  -  0 


(141) 


an  18-element  state  vector  can  be  composed  from  d,  ^p,  Vv,  and  the 
elements  of  6C.  This  state  vector,  x,  obeys  a  linear  differential 
equation 


where  the  elements  of  F  are  composed  from  the  elements  of  C,  the 
accelerations  measured  by  the  platform  accelerometers  and  the  angular 
rates  measured  by  the  strapdown  system  gyros.  Many  of  the  elements  of 
F  are  zero.  The  filter  input  is  the  vector  d,  provided  by  integrating 
the  acceleration  difference  A,  The  elements  cf  d  are  velocity  differences 
in  the  direction  of  the  platform  axes.  The  18  state  variables  indicate 
that  there  are  324  elements  in  the  error  covariance  matrix.  Since 
rapid  alignment  or  estimation  of  6C  is  desired  using  continuous  measure¬ 
ments,  a  precomputed  filter  gain  matrix  may  be  necessary.  Because  any 
prescription  of  the  K  matrixreqtrfcwes  knowledge  of  F,  preplanned  maneuvers 
must  be  executed  precisely  in-  order  to  obtain  the  accuracies  promised  by 
the  error  covariance  analysis. 

If  angular  maneuvers  are  restricted  during  alignment  in  order  to 
avoid  the  singularity  in  the  differential  equations,  the  three  Euler 
Angles  can  be  estimated  using  the  Extended  Kaxman  Filter.  The  size  of 
the  state  vector  is  then  reduced  to  12  elements.  However,  the  elements 
of  the  F  matrix  for  this  case  are  more  difficult  to  calculate,  involving 
sines  and  cosines  of  time-varying  Euler  Angles.  Again  the  filter  gain 
matrix  may  be  too  complex  for  anything  but  precomputation.  It  should  be 
noted  that  alignment  using  Euler  Angle  estimates  does  not  restrict  the 
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relative  orientation  of  tlie  two  system?,  after  estimation  19  'ampleted. 
The  Euler  Angle  estimates  are  converted  into  direction  cosines  at  the 
end  at  filtering  in  order  to  eerreet  the  transformation  matrix. 

It  is  nr.t  cleat  what  meaning  can  be  attached  to  the  sum  ot  errat 
vaiiancee  in  the  estimates  of  the  Euler  Angles  or  the  elements  of  u. 

An  indication  of  filter  aeeuraey  with  some  physical  meaning  is  required, 
if  the  i  rnr  in  RCi  6Ci  results  From  a  small  misalignment,  the  product - 
of  the  transpose  of  the  true  transformation  matrix  and  the  computed 
matrix  is  a  third  transformation  which  can  be  approximated  by 


r  *  <p 


* 


APj,  1 


Wy  V>X  l 


The  email  angles  $y,  and  are  the  angular  orientation  errors  about 
three  orthogonal  a«es  (x,  y,  and  e)  that  are  described  by  6C. 

Re-nenber lug  that 
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a  «a«a»nsMe  ft gu> e-ot =B@f t t  ie  the  sum  of  the  mean  square  errors  in  the 
gsi  UaUt  of  #s,  and  #8.  In  Ib'-bs  of  errors  In  the  Ballasts  of  6C, 

ai  t  Hite  i  an  tie  e.preaaed  aa  rhe  mean  value  ut 
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lh*  vectors  and  _6C^  ar*  the  1th  column  vectors  of  the  C  and  6c 

matrices.  The  averaging  process  involves  only  the  elements  of  the  6C 
matrix  because  C  Is  deterministic.  When  the  Kalman  Filter  is  estimating 
6C  directly,  the  £igure-o£-merit  can  be  expressed  in  terms  of  the  true 
direction  cosines  and  elements  of  the  error  covariance  matrix  which  lie 
both  on  and  off  the  diagonal.  When  the  filter  estimates  Euler  Angles, 
the  error  covariance  matrix  elements  enter  the  f igure-of-merit  in  a  more 
complex  fashion.  Of  course,  this  evaluation  of  filter  accuracy  is  only 
-conducted  during  preliniaary  analysis  of  the  Kalman  Filter  alignment 
technique. 


me  IP  *652 


Section  9.  KALMAN  FILTER  IMPLEMENTATION  CONSIDERATIONS 


In  thia  section  some  of  the  practical  details  of  implementing  the 
Kalman  Filter  are  discussed.  The  purpose  here  is  to  introduce  the 
reader  to  a  few  problems  and  to  demonstrate  common  approaches  to  reducing 
them.  Of  course,  practical  considerations  generate  subjective.  solutions.^ 
Consequently,  no  attempt  is  made  to  discuss  all  of  the  problems  encountered 
and  the  approaches  presented  are  not  the  only  ones  possible. 


COMPUTER  COMPLEXITY 

The  compact  vector-matrix  notation  in  which  the  Kalman  Filter 
equations  are  written  is  deceptive.  Literally  thousands  of  multiplica¬ 
tions  can  be  described  by  a  few  strokes  of  the  pen  and  equations  can 
easily  be  written  that  cannot  be  solved  quickly  enough  by  even  the 
largest  and  fastest  modern  computers.  Many  reports  are  available,  and 
many  more  will  be  written,  describing  in  detail,  for  one  system  or 
another,  the  memory  requirements  and  number  of  computer  operations  needed 
to  incorporate  a  single  external  measurement  using  the  Kalman  Filter. 

Among  these  are  Ref.  2,  describing  airborne  alignment  and  cruiae  error 
removal  using  position  fixes  and  Doppler  velocity  information,  and 
Ref.  33  which  compares  Xalman  Filter  computer  requirements  to  those  for 
a  growing-memory  digital  filter. 

A  few  general  comments  can  be  made  to  illustrate  how  demands  on 
the  computer  are  related  to  the  formulation  used  in  the  Kalman  Filter. 
Basically,  the  computer  requirements  are  related  to  the  number  of  elements 
in  the  state  vector  and  the  number  and  repetition  rate  of  external 
measurements.  The  computer  time  requirement  is  directly  related  to  the 
frequency  at  which  measurements  reach  the  discrete  filter,  because  the 
covariance  and  estimation  difference  equations  are  solved  with  each  new 
input.  Also,  to  he  useful,  the  filter  equation  (Eq.  20)  must  be  solved 
in  a  small  fraction  of  the  time  between  measurements.  The  continuous 
filter  requires  solution  of  differential  equations  and,  if  a  digital 
computer  is  being  used,  the  time  step  size  required  determines  whether 
any  computer  time  is  available  for  other  calculations. 

The  number  of  d..tJj.tal  computer  operations  necessary  to  incorporate 
each  new  measurement  (or  the  number  of  integrators,  multipliers,  and 
resolvers  in  an  analog  computer  implementation  of  the  continuous  filter) 
is  largely  determined  by  the  state  vector  size.  One  of  the  basic 
differences  between  conventional  filters  and  the  Kalman  Filter  is  that 
the  latter  attempts  to  measure,  random  errors  if  they  are  time-correlated. 
This  feature  is  also  the  major  cause  of  large  state  vectors  in  the  filter 
equations.  Unfortunately,  stale  vector  size  and  computational  complexity 
are  not  linearly  related.  The  matrix  difference  (or  differential) 
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equations  describing  error  covariance  behavior,  Eq.  21,  25,  and  29, 
represent  n2  scalar  equations  where  n  Is  the  number  of  state  variables. 
Furthermore,  the  multiplication  of  two  u  s  n  matrices,  often  required  in 
the  solution  of  these  equations,  represents  n3  separate  scalar  multi¬ 
plications  that  most  be  carried  out  by  the  computer.  The  seriousness  of 

shis^ situation  is  often  relieved  in  particular  applications  through - 

efficient  programming.  This  is  possible  when  many  of  the  matrix  elements 

ere  aero. 

Computer  requirements  are  reduced  if  Che  matrices  which  appear  in 
the  system  and  error  covariance  differential  equations  are  constant. 
Analytic  solutions  exist  for  the  error  covariance  matrices  for  the 
discrete  and  continuous  filters  when  F,  H,  G,  Q,  and  a  are  constant 
(Ref.  7  and  34).  Implementation  of  these  solutions  is  usually  less 
demanding  of  computer  time  if  the  measurement  schedule  is  periodic  and 
the  interval  between  measurements  is  much  longer  than  the  time  stop 
required  for  ac  ;urate  solution  of  the  differential  equations. 

A  problem  sometimes  arises  when  an  error  covariance  matrix  is 
reduced  from  an  initially  large  value  to  a  very  small  quantity.  In  this 
case,  slpnific'Uit  digits  are  frequently  lost  and  the  positive  definiteness 
of  the  covariance  matrix  can  be  destroyed.  A  square  root  formulation 
of  the  Kalman  Filter  has  been  developed  which  is  helpful  in  this  situa¬ 
tion  (Kef.  35).  It  avoids  the  necessity  cf  using  double  precision  in 
this  case  or  permits  the  use  of  shorter  word  lengths  tnan  might  otherwise 
be  required  for  problems  of  this  sort.  On  the  other  hand,  the  square 
root,  formulation  requres  more  calculations  than  the  single  precision 
conventional  formulas.  Also,  if  measurements  provide  knowledge  of  some 
state  variables  that  is  much  more  accurate  than  the  estimates  immediately 
prior  to  observation,  Eq.  22  is  a  more  precise  equation  for  updating  the 
error  covariance  matrix  than  Eq.  25  (see  Ref.  36). 

Frequently,  a  reduction  in  computer  requirements  cm  be  achieved 
by  prefiltering  the  external  measurements.  Consider  the  case  where 
Doppler  velocity  measurements  are  used  to  aid  an  inertial  navigation 
system  (Ref.  2).  The  velocity  indications  are  available  several  times 
a  second  but  velocity  errors  are  essentially  constant  over  a  much  longer 
period.  By  averaging  the  differences  between  Doppler  measurements  and 
inertial  system  indications  over  several  seconds  the  correlation  between 
measurement  errors  at  the  input  to  the  Kalman  Filter  may  be  reduced  to  a 
negligible  amount.  /.  double  reduction  of  computer  requirements  can 
result;  the  state  vector  size  may  be  reduced  because  it  is  no  longer 
necessary  to  cot.Bider  correlated  measurement  errors,  and  the  measure¬ 
ments  reach  the  filter  lesB  frequently,  permitting  slower  calculation 
rates.  The  averaging  process  causes  a  significant  reduction  in  the 
mean  square  measurement  noise,  providing  fewer  measurements  of  higher 
quality.  However,  an  additional  measurement  error  does  occur  because 
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the  average  is  biased  when  the  inertial  system  velocity  error  is  changing 
during  the  prefiltering  process.  Is  general,  this  technique  is  useful 
because  the  Doppler  velocity  measurements  are  provided  such  sore  fre¬ 
quently  than  necessary. 


It  frequently  happens  that  the  system  model*  painstakingly  con¬ 
structed  during  the  initial  analysis  to  Include  every  possible  detail, 
is  later  sharply  reduced  because,  of  computer  limitations.  If  this 
reduction  is  to  be  accomplished  without  making  the  Kalman  Filter  useless, 
a  means  for  analyzing  its  effect  on  accuracy  is  necessary.  Such  a 
procedure  is  outlined  under  "The  Effects  of  Imperfect  Models"  (p.115). 

As  usual,  practical  considerations  dictate  an  engineering  approach  to 
Implementation  of  the  Kalman  Filter.  It  is  necessary  to  determine 
trade-offs  between  accuracy  and  computer  complexity.;  The  final  choice 
is  at  least  partly  subjective.  Typical  state  vector  size  for  Kalman 
Filter  applications  to  inertial  navigation  systems  ranges  from  6  to  21 
elements.  Computer  memory  requirements  range  from  approximately  1,200 
to  approximately  4,000  words,  reflecting  Che  fact  that  efficient  pro¬ 
gramming  can  partially  relieve  the  "curse  of  dimensionality."  Unfor¬ 
tunately,  the  larger  state  vectors  usually  appear  in  aircraft  applica¬ 
tions  where  measurements  are  taken  more  frequently  and  computer  size  13 
more  critical. 
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OBSERVABILITY 

In  any  situation  where  many  variables  are  to  be  measured  or  estimated 
by  observing  a  small  number  of  output  quantities,  the  question  of  observa¬ 
bility  arises.  For  example,  in  the  state  and  measurement  equations 
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the  variable  X3  is  not  observable.  Bo  amount  of  filtering  of  the 
measurements  will  improve  the  accuracy  In  knowledge  of  x3.  The 
literature  contains  many  statements  of  the  strict  mathematical  definition 
for  obsurvability  (see  Ref.  7  and  8).  Mote  common  in  the  application 
#f  the  Raiftan  Filter  to  Inertial  navigation  systems  Is  the  observability 
problem  demonstrated  by 


+  Gu_ 


(147) 


Z  ■  Xi  +  V 


(1*8) 


where  the  f  elements  are  time-varying  but  ci  and  C2  are  constant. 

Equations  147  and  148  Illustrate  the  case  where  two  variables  (x2  and  X3) 
can  be  recovered  from  the  measurement  only  as  a  linear  combination.  This 
Is  the  situation  discussed  in  Section  8  where  the  velocity  difference 
between  two  nearly  coincident  inertial  systems  is  influenced  in  the 
same  way  by  platform  level  misalignment  and  constant  level-accelerometer 
errors.  The  two  effects  are  not  separable.  A  similar  situation  arises 
In  estimating  constant  east  gyro  drift  rate  and  azimuth  error  in  a 
north-vertical  system  when  only  position  measurements  are  available. 

The  Kalman  Filter  corrects  the  estimates  of  the  two  insepara'  le  variables 
.according  to  the  variances  of  their  estimation  errors.  If  one  variable 
is  known  much  more  accurately  than  the  other,  almost  all  of  the  difference 
(z-xj)  is  used  to  correct  the  least  precise  estimate.  For  the  problem 
discussed  under  "Gimballed  System  Transfer  Alignment"  (p.  94),  when  the 
initial  uncertainty  in  g<ty  is  much  greater  than  the  standard  deviation 
of  X-axis  accelerometer  error,  the  Kalman  Filter  will  attribute  the 
entire  effect  to  the  tilt  angle,  4>y.  As  a  result,  che  RMS  steady-state 
estimation  errors  in  g$y  and  ?x  are  identical  and  essentially  efual  to 
the  RMS  accelerometer  error.  There  is  no  accuracy  improvement  in  the 
estimate  of  constant  accelerometer  error.  If  the  two  initial  error 
variances  were  approximately  equal,  both  estimates  would  be  improved  by 
the  Kalman  Filter.  Only  when  the  two  errors  are  made  separately 
observable  by  providing  an  additional  measurement  or  a  time-varying 
element  In  the  system  matrix  can  both  estimates  be  improved  by  the  filter 
regardless  of  the  initial  error  variances. 


| 

1 

\ 

I 


! 


106 


NWC  TP  4652 


SUBOPTIHAL  FILTERS 

Several  forma  of  suboptimal  filters  have  already  been  suggested. 
Generally,  a  suboptisal  filter  is  a  modification  or  simplification  of 
the  optimal  or  Kalman  Filter.  In  a  aenae,  any  Kalman  Filter  is  sub- 
optimal  because  all  the  effects  on  system  state  behavior  can  never  be 
determined.  The  important  consideration  in  going  from  the  Kalman  Filter 
to  a  suboptisal  formulation  is  art  ability  to  analyze  the  effect  on 
accuracy  that  is  produced  by  the  change. 

Simplified  Model 

In  order  to  reduce  computational  complexity,  certain  known  dynamics 
that  exist  in  the  system,  its  disturbances,  or  in  the  measurement  errors 
are  often  intentionally  ignored.  Of  course,  this  neglected  behavior  is 
understood  by  the  designer  to  have  a  minor  effect  on  the  state  variables 
of  interest.  The  new,  simplified  dynamics  are  described  by  a  state 
differential  (or  difference)  equation  and  a  measurement  equation  similar 
in  form  to  those  for  the  original,  complete  system.  The  same  error 
covariance  equations  can  be  applied  to  the  simplified  system,  though 
reduction  in  state  vector  size  will  reduce  the  computer  capability 
required  for  their  solution.  In  a  like  manner,  the  same  equations  are 
used  to  find  the  Kalman  Filter  gain  matrix.  Unfortunately,  the  error 
covariance  matrix  found  udng  the  simplified  forms  of  system,  measure¬ 
ment,  or  random  vector  covariance  matrices  does  not  provide  correct 
values  for  the  estimation  errors  in  the  complete  system.  It  is  only 
correct  when  the  true  system  is  accurately  described  by  the  simplified 
equations.  To  analyze  the  effect  of  using  the  simplified  filter,  a 
sensitivity  analysis  must  be  conducted.  A  discussion  of  sensitivity 
analyses  is  provided  on  p.  114.  These  computations  generate  the  error 
covariance  matrix  for  the  complete  state  vector  estimate  when  the  filter 
incorporates  the  simplified  gain  matrix  and  the  simplified  descriptions 
of  state  dynamics  and  the  measurement  process.  The  errors  described  can 
be  compared  to  those  calculated  for  the  complete  Kalman  Filter,  and 
trade-offs  are  determined. 

As  an  example  of  simplifying  state  dynamics,  consider  the  use  of 
stellav  measurements  to  correct  inertial  navigation  system  errors.  Star 
sightings  usually  measure  the  error  angles  between  computed  and  glatform 
axes,  described  by  the  vector  ip.  The  differential  equation  for  ip  Is 
given  in  Appendix  C  as 


ip  -  ip  x  uj  +  £ 


(149) 
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if  stellar  measurements  are  taken  frequently  end  $  Is  therefore  kept 
small,  the  predominant  effect  In  the  differential  equation  is  the  drift 
rate  vector,  t .  The  entire  system  state  vector  differential  equation 
can  then  be  approximated  by  the  3—element  fora 
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Augmentation  la  made  to  account  for  the  correlation  properties  of  the 
gyro  errors,  but  the  resulting  state  contains  4  elements  less  than  that 
using  Che  system  state  description  provided  in  Eq.  82.  In  reducing  the 
state  vector  size,  it  was  observed  that  certain  elements  were  being 
measured  directly,  and  the  usual  state  vector  formulation  was  changed 
(from  $  to  ij)}  to  acconaodate  that  fact.  In  addition,  certain  terms 
($  x  u>)  were  dropped  because  they  were  expected  to  have  little  effect 
on  the  state  vector  differential  equation.  The  consequence  of  these 
changes  is  a  reduced  state  vector  and  simpler  state  differential 
equations,  both  of  which  provide  smaller  computer  requirements. 

Reference  37  presents  results  of  computer  simulations  indicating  that 
the  simplified  filter  gives  good  accuracy  despite  these  approximations. 

As  a  practical  matter  it  is  often  vise  to  increase  the  magnitude 
of  the  disturbance  covariance  matrix,  Q,  when  system  model  simplifications 
are  made.  Frequently,  fictitious  system  disturbances  are  assumed  where 
none  exist.  These  adjustments  account  for  the  errors  in  state  extrap¬ 
olation  caused  by  approximations  In  the  model.  The  effect  is  to  make 
the  filter  gains  higher,  thereby  making  the  filter  more  dependent  on 
measurements  and  less  dependent  on  inaccurate  state  vector  extrapolation. 

Simplifications  of  the  system  model,  the  measurement  model,  or  the 
error  correlation  properties  can  be  made  in  many  cases.  Based  on  the 
knowledge  that  certain  effects  or  terms  are  relatively  minor,  they  are 
made  with  the  intent  of  reducing  computer  requirements  for  the  filter 
or  for  filter-gain  matrix  calculations.  Eventually,  a  sensitivity 
analysis  as  outlined  in  "Effects  of  Imperfect  Models"  (p.  115)  is  neces¬ 
sary  to  establish  the  accuracy  trade-offs  involved. 

Precomputed  Gains 

A  great  deal  of  the  Kalman  Filter  computer  burden  can  be  relieved 
if  the  error  covariance  equations  can  be  solved  beforehand  and  the  filter 
gain  matrix  computed  and  stored  for  use  during  subsequent  filter  opera¬ 
tion.  As  mentioned  earlier,  this  is  only  possible  when  the  measurement 
schedule  and  system  dynamics  are  known  in  advance.  If  no  new  informa¬ 
tion  about  system  and  measurement  behavior  (including  the  statistics  of 
disturbances  and  measurement  errors)  arises  during  filter  operation,  a 
Kalman  Filter  employing  correct  precomputed  gains  remains  optimum.  When 
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Che  Kalman  Filter  is  applied  to  inertial  navigation  syrteas,  vehicle 
course  and  speed  during  filtering  must  be  uasuiacd  to  permit  precomputed 
gains.  If  any  deviation  t rom  this  trajectory  can  occur,  a  sensitivity 
analysis  will  reveal  wltat  changes  will  cake  place  In  Che  estimation 
error  statistics. 

When  precomputed  filter  gains  are  used,  further  simplification  can 
be  made  by  modifying  their  time  behavior .  Often,  only  the  sLeady-state 
filter  gains  (when  they  exist,  see  p.  17)  are  used.  This  is  equivalent 
to  using  the  Wiener  filter.  It  permits  the  storage  of  a  number  of  con¬ 
stant  quantities  equal  to  the  product  of  state  vector  dimension  with 
measurement  vector  sire.  Less  drastic  simplifications  of  the  filter 
gain  time  behavior  are  often  produced  by  approximating  the  iavior  of 
gain  matrix  elements  by  analytic  or  discontinuous  functions  of  time. 

Figure  42  illustrates  the  use  of  a  declining  exponential  or  a  two  level 
constant  to  replace  a  gain  element  with  similar  behavior.  In  both  cases 
the  computer  memory  requirement  is  reduced  to  storing  a  small  number  of 
constants  and  the  gain  element  is  easily  computed  when  it  is  required. 

If  the  system  behavior  is  dependent  on  quantities  other  than  time, 
filter  gains  can  be  precomputed  for  a  range  of  these  variables  and  an 
interpolation  scheme  applied  after  they  are  determined.  In  navigation 
systems  the  gain  elements  may  depend  on  vehicle  course  and  speed .  More 
generally,  the  gains  in  the  extended  Kalman  Filter  may  depend  on  the 
state  variables  themselves.  An  illustration  of  this  case  arises  in 
using  the  Kalman  Filter  to  estimate  position  and  velocity  of  an  unknown 
ballistic  reentry  vehicle.  Nonlinear  state  equations  result.  Furthermore, 
the  filter  equations  must  be  solved  quickly  and  precomputed  gains  are 
very  desirable.  However,  certain  gain  matrix  elements  can  be  specified 
by  interpolation  on  the  basis  of  estimated  altitude  (Ref.  38).  Other 
precomputed  gain  elements  were  insensitive  to  all  known  physical  param¬ 
eters  and  their  time-varying  characteristics  were  approximated.  A 
sensitivity  analysis  revealed  little  deterioration  in  accuracy  resulted 
from  the  filter  gain  approximations.  Figure  43  compares  results  for  the 
optimum  and  suboptimum  filters.  Of  course  these  are  single  simulation 
runs  made  with  identical  random  disturbances  and  measurement  noise. 
Similarity  of  ensemble  error  statistics  was  established  by  sensitivity 
analysis  and  Monte  Carlo  techniques. 

When  approximations  to  the  optimal  filter  are  produced  by  modifying 
the  filter-gain  matrix  behavior  only,  analysis  of  the  effect  on  error 
covariances  is  easily  performed.  For  the  discrete  filter,  Eq.  22  can  be 
used  to  compute  the  error  covariance  matrix  with  any  filter-gain  matrix. 

A  similar  expression  for  the  continuous  filter  is  given  by 


P  =  (F  -KH)  P  +  P(F  -KH)T  +  KRKT  +  GQGT 


(151) 
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By  substituting  the  modified  gains  in  one  of  these  equations,  filter 
accuracies  can  be  obtained  for  comparison  with  those  resulting  when  the 
optimum  filter  is  used.  If  the  system  state  dynamics  and  measurement 
process  are  also  changed,  a  more  elaborate  scheme  is  required  to  determine 
the  estimation  errors.  This  is  outlined  in  subsequent  sections.  As 
with  all  other  attempts  to  simplify  the  filter,  modified  descriptions  of 
filter  gain  are  usually  based  on  insight  into  the  problem  at  hand. 

Decoupling  Equations 

Many  classical  analyses  of  inertial  navigation  systems  were  simplified 
by  separating  portions  of  the  problem.  Small  cross-coupling  terms  in  the 
differential  equations  were  ignored  and  one  large  set  of  equations  was 
reduced  to  two  or  more  smaller  sets.  A  similar  approach  can  be  taken 
in  order  to  simplify  the  Kalman  Filter  equations.  Though  the  decoupling 
of  system  dynamics  is  usually  based  on  good  physical  intuition,  detailed 
mathematical  approaches* do  exist  (see  Ref.  39). 

Referring  to  the  system  described  in  Section  5,  the  terms  in  the 
matrix  Fx  of  fiq.  84  involving  vehicle  accelerations  or  coordinate  frame, 
angular  rates  are  typically  much  smaller  than  the  others.  They  are  the 
cross-coupling  terms  relating  the  two  level  loops  and  the  azimuth  drive 
of  a  north-vertical  inertial  system.  If  these  quantities  are  ignored, 

Fx  becomes 
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Now,  by  rearranging  rows  and  columns  of  Fx  (rearranging  the  order  in 
which  the  state  variables  appear  in  x)» 


0  10 
0  0  g 


0  -i  0 


0  0  0 


0  0  0 


0  0  0 


0  0  0 


0  0  0 
0  0  0 


0  0  0 


0  1  0 


0  0  -g 


0  K  0 


(153) 


0  0  0  I  0 


for  the  state  vector  defined  by: 


X T  =  [6Rx  6Rx <py  6Ry  6Ry  ^ ^ 


(154) 


The.  partitioning  lines  in  the  system  matrix  serve  to  illustrate  the  . 
fact  that  Fx  is  composed  from  zeros  except  for  the  submatrices  along 
the  diagonal.  The  state  vector-matrix  equation  can  be  decomposed  into 
three  independent  sets  of  differential  equations.  A  considerable 
reduction  in  computer  time  and  memory  requirements  results.  The  added 
consideration  of  correlated  sensor  errors  doe3  not  alter  the  situation. 
When  gyro  and  accelerometer  errors  are  constant,  the  three  state  equations 
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6R  0  0  g  I  1  0  6r 

x  |  a 

%  -  s 

$  0  0  0  J  0  0  v 

x  I  X 

I 

t  0  0  0  I  0  0  e 

V  1  Xf 


(155) 


113 


NWC  TP  4652 


r.  i 

■ 

• 

4Ry 

0 

1 

°L 

0 

0 

M 

6R 

0 

0 

-g ! 
i 

1 

0 

y 

* 

0 

1 

R 

0 ! 

0 

1 

• 

V 

0 

0 

~0~| 

"o 

~0~ 

y 

1 

• 

c 

0 

0 

o ! 

0 

0 

_X  J 

- 

and 


(156) 
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No  measurement  equation  is  available  for  the  state  given  by  Eq.  157. 

It  is  unobservable.  The  error  covariance  equation  for  this  state  vector 
is  given  by  Eq.  14  or  21.  A  marine  inertial  navigation  system  is  treated 
in  Ref.  39.  By  eliminating  cross-coupling  terms,  the  state  is  reduced 
from  one  vector  of  16  elements  to  four  vectors  with  4  elements  each. 
Analysis  of  the  relative  accuracy  for  this  scheme  compared  to  the  full 
Kalman  Filter  indicates  that  estimation  errors  do  not  increase  signif¬ 
icantly  as  a  result  of  the  approximations  involved  in  decoupling. 


SENSITIVITY  ANALYSES 

The  error  covariance  matrix  computed  for  the  Kalman  Filter  by 
Eq.  21  and  25  or  Eq.  29  is  based  on  the  assumption  that  the  description 
of  system  dynamics  and  the  measurement  process  is  exactly  correct.  In 
addition,  the  random  disturMTCBS "and  measurement  errors  are  assumed  to 
be  correctly  described  by  the  covariance  matrices  provided.  Because 
some  uncertainty  about  the  true  system  behavior  or  measurements  may 
exist  or  because  the  random  vector  covariance  matrices  are  usually 
calculated  from  incomplete  empirical  data,  a  technique  for  checking 
the  effect  of  incorrect  descriptions  is  desirable.  Cnee  established, 
the  same  relations  can  also  be  used  to  investigate  the  relative  accuracy 
of  subopt^.mal  filtering  schemes.  This  section  provides  a  brief  discus¬ 
sion  of  the  steps  necessary  to  perform  sensitivity  analyses  and  to  check 
suboptiraal  filter  formulations. 


The  Effects  of  Erroneous  Statistics 

Imperfect  specification  of  the  statistics  for  random  disturbances 
and  measurement  errors  in  not  uncommon.  These  quantities,  as  they  appear 
in  the  R  and  Q  matrices  are  usually  computed  from  incomplete  data.  For 
-  example,  gyro  drift  rate  data  may  be  available  from  tests  performed  on 
a  limited  number  of  similar  gyros.  Also,  these  teste  may  have  been  of 
an  undesirably  short  duration  and  the  laboratory  environment  probably 
differs  significantly  from  that  of  the  inertial  navigator.  Obviously, 
the  statistical  behavior  of  the  drift  rate  for  this  particular  model 
gyro  is  not  thoroughly  established  by  these  testa.  Broad  confidence 
limits  exist  for  the  statistical  drift  rate  descriptions.  However,  the 
Kalman  Filter  formulation  requires  that,  for  the  error  covariance  analysis 
to  be  accurate,  the  exact  statistical  behavior  of  random  quantities  be 
described  in  the  K  or  Q  matrices  and  in  the  initial  error  covariance, 
F(t0).  In  order  to  determine  the  effect  incorrect  error  statistics  will 
have  on  the  filter  estimation  errors,  a  range  of  values  for  these 
matrices  may  be  investigated.  The  sensitivity  curve  thet  can  result  is 
illustrated  in  Fig.  44. 

When  tn  incorrect  description  of  error  statistics  is  used  to  find 
the  filter  gain  matrix,  the  true  error  covariance  matrix  which  results 
c.au  be  determined  using  Eq.  22  for  the  discrete  filter.  The  filter  gain 
matrix  is  computed  In  the  usual  manner,  based  on  the  best  guess  of  error 
statistics.  To  check  the  effect  of  an  incorrect  choice,  a  different 
value  of  Q,  R,  or  P (to)  ie  substituted  in  Uq.  21  and  22  with  the  same 
values  for  K,  A  new  history  of  estimation  errors  results.  Comparison 
mith  the  original  error  cuvarisnees  indicates  the  sensitivity  of  the 
Kalman  Filter  to  incorrect  statistics.  A  similar  procedure  can  be 
carried  out  for  the  continuous  filter  using  Eq.  151.  (See  also  Ref.  40.) 

The  Effects  of  Imperfect  Models 

A  more  complex  analysis  is  required  to  determine  the  sensitivity 
of  a  Kalman  filter  to  changes  or  errors  in  the  system  equations  or  the 
measurement  process.  Consider  the  problem  of  analvaing  simplifications 
in  the  filter.  The  designer  knows  the  true  state  and  its  b@hnvior=-thls 
represents  his  best  understanding  of  the  system  operation.  A  good 
description  of  the  measurement  is  also  available.  The  true  state  dif¬ 
ference  equation  for  the  discrete  formulation  is  written  ...... 


x  , .  B  $  x  +  w  (138) 

-«+l  n  -n  =n 
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Chosen  RMS  Gyro  Drift  Rate 
Actual  RMS  Gyro  Drift  Rate 

FIG.  44,  Sensitivity  of  RhS  Position  Error  to  Error 
in  Estimated  G>ro  Drift  Rate. 


But,  for  simplicity,  the  filter  operates  with  a  different  set  of  transi¬ 
tion  end  measurement  matrices  described  by  4>*  and  H$.  The  estimate  of 
the  state  immediately  after  each  measurement,  obeys. 

Ski  ■  *!  *£  +  [j£n  -K  *S  SKJ  usjj 

which  is  similar  to  Eq.  20.  It  should  be  noted  that  frequently,  as  a 
result  of  simplifying  the  state  vector,  may  not  contain  as  many 
elements  as  thu  true  state,  x.  Consequently,  the  error  of  interact 
must  be  expressed  as 


X  «  X  -  w  8* 
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where  the  matrix  W  accounts  for  the  difference  in  state  vector  dimension 
and  for  any  licear  transformation  that  may  be  used  in  defining  the 
simplified  state.  As  before,  the  quantity  of  interest  is  the  error 
covariance 


P  ■  cov  (x,  x)  _ 

-  E  <£.  £)T 

**  cov  (jc,  x)  “  [cov  (x,  x*)]  WT 

-  W  cov  (x*,  x)  +  W[cov  (x* ,  x*)]  WT 


(161) 


The  covariances  required  to  solve  for  the  estimation  error  covariance 
matrix  using  Eq.  161  can  be  calculated  by  defining  a  new  vector,  _r, 


Remembering  that 


« T-l 

1  FJ 


£«  -  Hn  *n  +  Xa 


(163) 


a  difference  equation  for  _r  is  found  using  Eq.  15b  and  159 


Kn  Hn  ]  (*-<  «J)  K 


r*n"l  f  Hn  1 

.  Pi  +  [< 


In  Eq.  164,  starred  matrices  refer  to  those  used  in  the  simplified  model 
of  the  Kalman  Filter.  The  new  state  ’’ariable  difference  equation  is  in 
the  form  of  Eq.  8.  Given  initial  conditions  for  the  covariance  of  jr, 
that  matrix  can  be  calculated  for  all  future  measurement  times  using 
Eq.  12.  The  covariance  of  r  can  be  expressed  by 


cov(x,  x)  [  cov(x,  x*)  I 

(£>  L>  “ - - 

cov  (x* ,  jt)  |  cov (x* ,  x*)J 


The  quantities  needed  to  solve  Eq.  161  are  contained  as  submatrices  of 
the  covariance  foi  the  new  vector,  as  shown  in  Eq.  16b.  Notice  that, 
unless  the  true  state  and  the  simplified  state  have  the  same  dimension, 


eov(x*,  2<)  and  cov(x,  4*) 


are  not  square.  Several  computer  programs  solving  matrix  difference 
equations  of  the  form  given  by  Eq,  12  are  in  widespread  use. 

More  efficient  calculation  of  the  matrices  on  the  right  side  of 
Eq.  161  result  from  the  observation  chat 


cov(x*,  x)  ■  (ccv(x,  x*)]T 


(166) 


Defining 

Pi  -  cov(x,  it) 

P2  -  cov(x*.  x*)  (167) 

?3  -  cov(x,  4*) 

smaller  matrix  difference  equations  cen  be  written  for  Pi,  P2,  and  P^: 


**ln+l  *  $  ?i_  +  Q_ 

n  n  a  tx 


P. 


,  =  K*  H  P,  HTK*T  +  K*H  Pj  ... 
n+1  n  n  n  n  n  nn^nn 


a„eT  a  >t 


* « -  KJ K;  >  ■ K  <  h.t  k;t*  a-  k;  «:>♦;  ».Bq' T«  -  k  h:>t 


(168) 


F. 


a n+l  *  *n  ?ln  Hn  Kn  +  K  Pi„  *S  ff  -  K*  H*  )  J 
n  nn  n  n  nn  nn' 


Once  the  error  covariance  has  been  computed  using  Eq.  161,  it  can  be 
compared  to  that  resulting  from  the  true  system  as  calculated  by  Eq.  21 
and  25.  Of  course,  a  similar  procedure  is  available  for  the  continuous 
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When  the  sensitivity  of  a  Kalman  Filter  design  to  correct  specifi¬ 
cation  of  the  true  system  is  to  be  investigated,  the  same  procedure  is 
followed.  However,  the  $*  and  H*  matrices  are  now  those  used  in 
designing  the  filter  and  K*  is  the  resulting  filter-gain  iratria.  The 
altered  $  and  H  matrices  are  substituted  for  the  unstarred  quantities  j 

in  the  above  equations.  | 


All  of  the  calculations  in  this  section  are  carried  cut  off-line, 
before  actual  use  of  the  filter.  They  provide  a  complete  approach  for 
analyzing  the  sensitivity  of  the  Kalman  Filter  to  erroneous  specification 
of  system  and  measurement  behavior  or  to  incorrect  statistics  for  random 
quantities. 
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Appendix  A 

covarxamce  matrices 


The  covariance  matrix  for  two  random  vector  processes  is  defined 
in  terns  of  the  ensemble  average  values  of  the  vectors  and  the  ensemble 
average  value  of  their  outer  product.  The  covariance  matrix  for  a(t) 
and  j>(t)  is  given  by  (£  denotes  ensemble  expectation) 

covta(t),  b(t)]  -  E  l£<0  bT<03  -E  E  [bT(t)i  (169) 


Since  only  zero  mean  quantities  are  dealt  with  In  Kalman  Filter  work, 
the  simplification 


cov(a(t),  b(t)]  -  E  (a(C>  £"<«:)] 


ecu  be  made.  The  covariance  of  the  errors  in  the  Kalman  Filter  estimate 
of  the  state  x  is  described  by  the  matrix  P 


P(t)  -  cov[x(t),  x(t)] 


Thu  covariance  matrix  for  system  disturbances  is  given  by 


Qn  -  cov^,  wn) 


in  the  discrete  filter,  and 


Q  ■  cov(u,  u) 


in  the  continuous  filter.  For  measurement  noises,  the  covariance  is  the 
same  In  both  cases: 


R  ■  cov(v,  v) 
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The  requirement  that  the  Beasuraaent  noise  and  ays tea  disturbances  be 
uncoLrelated  in  time  gives  the  restrictions 


cov(u(t),  ■  Q(£)  5(t-T) 

cav{v(t),  v(x)J ■-  R(t)  5<t-r) 


<17  A> 


in  the  continuous  estimation  case.  The  operator  6  is  the  Dirac  delta 
function.  When  the  discrete  version  of  the  Kalman  Filter  is  used,  the 
corresponding  requirement  is  that  disturbances  and  noises  must  be 
essentially  uncorrelated  over  the  smallest  measurement  interval. 


cov^,  Wjj)  -  0 


cov(^.  V  “  0 


for  m  t  n 


for  m  ■  n 


for  n  t1  n 


for  a  *»  n 


Though  it  seldom  arises,  the  case  when  measurement  noises  and  system 
disturbances  are  cross-correlated  can  be  treated  (Ref.  7). 


NOISE  AND  DISTURBANCE  COVARIANCES  FOR  THE  CONTINUOUS  FILTER 


In  the  discrete  version,  the  diagonal  elements  of  Rn  and  Qn  are 
readily  identified  as  che  mean  square  values  of  particular  elements 
from  the  random  noise  and  disturbance  vectors.  Computing  the  elements 
of  Q(t)  and  R(t)  macrices  used  in  Eq.  29  for  the  continuous  filter  in 
the  same  manner  would  be  incorrect.  Inspection  of  Eq.  29  reveals  that 
these  covariance  matrices  have  the  units  of  Qn  and  Rn,  respectively, 
multiplied  by  the  unit  of  time.  The  necessity  for  this  can  be  observed 
from  Eq.  174  because  the  Dirac  delta  function  carries  with  it  units  of 
time.  A  different  explanation  follows  from  the  fact  that  truly  uncor¬ 
related  signals  do  aot  exist  in  nature.  This  presents  no  problem  In 
the  discrete  case  because  disturbances  and  measurement  errors  whose 
correlation  time  is  insignificant  compared  to  the  smallest  observation 
interval  can  always  be  defined.  However,  when  tne  interval  Is  caused 
to  vanish,  what  are  considered  as  uncorrelated  random  signals  are 
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frequently  quantities  whose  autocorrelation  periods  are  such  shorter 
than  the  characteristic  times  of  the  system  and  the  measurements. 
Reference  16  shows  that,  under  these  circumstances,  the  derivative  of 
the  error  covariance  matrix  for  a  continuous  process  excited  by  a  random 
disturbance  depends  on  the  tints  integral  of  the  correlation 


E  ut(t)i 


Assuming  that  u(t)  is  exponentially  correlated  with  correlation  period 
1/0,  che  driving  term  becomes 


Q(t)  a  |  E  [«<*)  uT<t)] 


(176) 


If  one  element  of  u  has  a  mean  squared  value  of  a 2  and  a  flat,  one-sided 
power  spectral  density,  Suu,  out  to  a  bandwidth  8,  the  power  spectral 
density  is  related  to  a  2  and  8  by: 


S 


uu 


(177) 


and  the  corresponding  diagonal  element  of  the  Q  matrix  Is 

* 

«  *  2Suu 

THE  COVARIANCE  MATRIX  DIFFERENTIAL  EQUATION 

Given  the  state  vector  differential  equation, 

£(t)  -  F(t)  x(t)  +  G(t)  u (t) 


given  by 


(178) 


(179) 


* 

Combining  Eq.  177  and  178,  we  get  q  =»  2c*78.  This  result  differs 
from  that  In  the  footnote  on  p.  50  because  here  we  desire  to  approximate 
a  correlated  random  variable  by  an  equivalent  uncorrelated  signal.  In 
Section  4  we  found  the  strength  of  an  uncorrelated  signal  which  produces 
a  certain  size  output  when  passed  through  a  first-order  linear  filter. 
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we  wish  to  study  the  dynamics  of  the  error  covariance  matrix  P(t), 
defined  as 

P(t)  -  E  li(t)  xT(t)]  (180) 

Consider  the  function  P(t,  t-e) ,  where  e  is  a  small  position  number. 

P(t,t-e)  =  E  fl(t)  IT(t-e)j  (181) 

Differentiation  with  respect  to  time  yields 

P (t, t-< )  =  )  x  T  (t-< )  +  x (t)  x  T  (t-c )  ] 

=  F(t)|TLxvt)  x  T(t-e)]  +  G(t£[u(t)  xT(t-c)]  (182) 

+^(x(t)  xT(t-c)J  FT(t-c)  £[x(t)  uT(t-c) ]  GT(t-c) 


The  second  term  on  the  right-hand  side  of  Eq.  182  must  be.  zero,  as  there 
can  be  no  correlation  between  the  state  of  the  system  at  a  given  time  and 
a  driving  noise  which  exists  in  the  future.  To  evaluate  the  last  term  in 
this  equation,  we  use  the  solution  to  Eq.  179  given  by  Eq.  7  when  tn  is 
zero. 


x(t)  =  $(t,0)  x 


x(0)  +  J 


*(t,r)G(r  )u(r  )dr 


(183) 


Postmultip lying  Eq.  l&a«*y"j>£(t-e)  and  taking  the  ensemble  average  of 
both  sides  results  in 


E  Lx(t)  UT(t-<)]  =  $(t,0)  £lx(0)  UT  (t-C  )] 

t 

+jf  *  ft’7)  g(t)E  |u_(i1uT(t-f)jd  T 

=  *  (t,t-c)G  (t-c)Q  (t-c) 
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The  first  term  goes  to  zero  for  reasons. already  described,  and  the 
second  (integral)  term  is  readily  evaluated  due  to  the  delta  function 
in  the  integrand. 

Substituting  Eq.  184  into  Eq.  182  and  using  the  fact  that  $(t,t)  «  I, 
the  limit  as  t  0  yields 


P(t)  -  F(t)  P(t)  +  P(t)  FT(t)  +  G(t)  Q(t)  GT(t)  (185) 
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Appendix  B 

A  KALMAN  FILTER  DERIVATION 

It  is  possible  to  derive  the  Kalman  Filter  by  optimizing  an  assumed 
form  of  linear  estimator.  Based  on  the  desire  to  avoid  a  growing  memory 
filter,  a  recursive  estimator  is  sought  in  the  form  (see  Section  2): 

V+>  -  xn<-)  +  Kn|z„  -  Hn  X„(-)|  (186) 

where  and  x^d-)  are  the  estimates  of  state  vector  Xn  immediately 

before  and  immediately  after  the  measurement  zfl,  at  time  tn.  That  is, 
the  state  estimate  is  corrected  at  the  time  of  each  measurement  accord¬ 
ing  to  a  weighted  difference  between  the  actual  and  anticipated  measure¬ 
ment  vectors.  The  optimum  weighting  matrix  Kn  is  to  be  specified. 

An  equation  for  the  estimation  error  after  incorporation  of  the 
nth  measurement,  denoted  £„(+),  can  be  obtained  from  Eq .  186  through 
substitution  of  the  measurement  equation 


Hn  *i 


+  Xn 


(187) 


and  the  relations 


£n<+)  -  xn  +  Xn(+) 
*n(->  '  Xn  +  2Sn(-> 


(188) 


The  result  is 


Bn^+)  *  (  f  “  K-n  ^n )  Xn 


(189) 


Using  Eq.  .189,  the  expression  for  the  change  in  the  error  covariance 
matrix  when  a  measurement  is  employed  (Eq.  22)  can  be  derived.  From  the 
def  i  nl.  t  ion 


I*  <•  ! 
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cov  ,  X  (•),>■  (*  }  j 

n  n 


r l x  (ox 

*—  n  n 


(*  >j 


£yW?&  AS 


tq. 
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iui 


j^IVtlS 


v*»'E 


*-KV'«" «I,-n,-K«,‘/'  ri^il 

.K11,nS^(-ia-KnHnl1,,jK^)  I 
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E^„(-)S-n{-,J  "V** 
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and,  as  a  result  of  uncorrelated  measurement  errors, 


*n"V-l 


Ev  xf(-) 
-n  -  n  - 


-  0 


Thus 


V> 


K  H  )P „<->  a  -  K  H  ) 
n  n  n  n  n 


K  R  Kn 

n  n  n 


U90) 


1 1  1  a  desired  to  cisoose  K„  to  Einisiss  the  uus  sf  the  diagonal 
elements  (trace)  of  the  error  covariance  matrix  Pn(+). 

trace  [Pn(+)]  E£l  £  Xj  (+)  )S]=£U „(+)  *„<-> )J  (191) 

t  n 

This  is  equivalent  to  minimizing  the  length  of  the  estimation  error 
vector.  To  find  the  value  of  K„  which  provides  the  minimum,  it  is 
necessary  to  take  the  partial  derivative  of  the  trace  of  Pn(+)  with 
respect  to  and  equate  it  to  zero.  Use  is  made  of  the  relation  for 
the  partial  derivative  for  the  trace  of  the  product  or  two  matrices  A 
and  B 


dA  ltraCe  (ABAl')l 


2AB 
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If  B  ig  gye®«trlc.  Fro®  Eq*  190,  the  result  1b 

“2  ( I  -  Kn-H„)  ?„(-)  H Z  +  2Kn  Prt  -  0 


Solving  for  Hq, 


Kn  -  Pa(-1  «n  |  «;i  Pn(=)  H*  +  Rn 


-1 


(192) 


(193) 


which  is  the  Kalman  Filter  gain  matrix  ai  expressed  in  Eq.  24.  Sub¬ 
stitution  of.  Eq.  193  into  Eq.  190  gives 

Pn(+>  '  P„(-)  -  Pn(-)  H l  |Hn  Pn(-)  nl  +  R^~l  Hn  Pn(~)  (194) 

which  is  Eq.  25  in  the  text. 

A  Simpler  Form  for  Kn:  There  is  a  matrix  Inversion  relationship 
which  states  that,  tor  P  as  given  in  Eq.  194,  Pn~l  la  expressible  as 
(Ref.  10) 


P_1(*-)  ■=  P_1(-)  +  HT  R" '  H 
n  n  n  n  n 


(195) 


We  use  this  result  to  manipulate  K„  as  foxlowe 

Kn  “  V">  til  |«n  Pn(")  *£  +  A*]"1 

H_  P  (-)  HT  +  E 
“  n  n  n 

[h  P  (-)  HT  +  R_ 
n  n  n  «i 


pn(+>  p;x(+)  pn(->  « i 
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Expanding  and  collecting  terms  yields 


U.  -  F  (+)  IT  ’  I  +  a  1  H  p  (-)  HT  H  P  (-}  H1  +  R 
ns  a  ana  nnn  n  a 


-  P  {+)  HT  K  |fc  +  H  P  (-)  HTj  [h  P  (-}  H1  +  B  1  (196) 

a  d  n  |  n  an  a|  an  a  a  _ 


-  F  (+)  HT  e"1 
nnn 


which  Is  the  simpler  fora  sought.  The  equations  for  the  continuous 
Kalman  Filter  can  be  derived  in  a  similar  manner  or  will  result  from 
the  above  equations  by  taking  the  limit  a a  the  measurement  interval 
vanishes.  Although  the  derivation  here  was  for  an  assumed  recursive, 
Bingle-Btage  filter,  the  result  has  been  shown  tc  be  the  solution  for  a 
much  more  general  problem. 
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Appendix  C 

DERIVATION  OF  NAVIGATION  SYSTEM  ERROR  DYNAMICS 

Three  nearly  coincident  orthogonal  coordinate  frames  must  be 
defined  in  order  to  study  the  propagation  of  errors  in  an  inertial 
navigation  system.  The  three  axis  systems  are  different  only  to  the 
extent  that  errors  exist  in  the  navigator.  The  most  familiar  coordinate 
frame  considered  is  the  "ideal  or  true  navigation  frame."  Its  definition 
follows  one  of  those  presented,  under  Inertial  Navigation  Systems  (p.  34). 
The  remaining  two  frames  are  described  only  by  thier  relative  orientation 
with  respect  to  the  true  navigation  axes. 

The  "computer  axes"  are  defined  by  the  orientation  the  computer 
believes  the  navigation  axes  have.  In  the  absence  of  initial  condition 
errors,  the  computer  for  a  gimballed  north-vertical  system  will  calculate 
latitude  and  longitude  changes  by  twice  integrating  the  properly  scaled 
outputs  of  the  north  and  east  accelerometers.  If  the  accelerometer  out¬ 
puts  provide  incorrect  Indications  of  the  true  north  and  east  acceler¬ 
ation,  the  computer  and  true  axis  systems  will  no  longer  coincide.  For 
email  angle  misalignments  the  relative  orientation  can  be  described  by 
a  vector.  The  vector  60  represents  the  rotation  necessary  to  bring  the 
true  axes  into  coincidence  with  the  computer  axes. 

The  third  coordinate  system  of  interest  will  be  called  the  "platform 
axes."  This  description  is  proper  when  gimballed  inertial  systems  are 
being  considered.  A  more  general  definition — one  which  includes  the 
possibility  of  strapdown  systems — is  that  the  platform  axes  describe  the 
coordinate  frame  into  which  accelerometer  outputs  have  been  resolved  when 
they  leave  the  inertial  measurement  unit.  The  platform  axes  can  differ 
from  the  computer  axes  because  the  Inertial  angular  rate  demanded  of  the 
platform  by  the  computer  is  not  accurately  implemented  (gyro  drift  rates) 
and  because  the  commands  are  given  in  computer  axes  but  executed  in 
platform  axes.  The  small  angle  rotation  necessary  to  bring  the_computer 
axes  into  coincidence  wiLlrthe  platform  axes  is  represented  by  \p.  A 
similar  angle  relating  true  axes  to  platform  axes  is  written  as  <f>  and 
expressed  by 


4>  -  +  60  (197) 


Several  other  important  quantities  can  be  defined: 

w  ■  inertial  angular  rate  of  true  axes 

=  inertial  angular  rate  of  computer  axes 

0Jp  *  inertial  angular  rate  of  platform  axes. 
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The  veccors  ft,  V  and  e  are  defined  in  previous  sections  of  this  report. 
However,  the  use  of  subscripts  in  this  appendix  will  differ  from  the 
section  on  inertial  navigation  systems.  Here  the  subscripts  C  and  P  are 
used  to  indicate  relation  to  the  computer  axes  and  platform  axes, 
respectively,  while  the  absence  of  subscript  indicates  relation  to  the 
true  axes.  The  subscript  I  is  again  used  to  designate  inertially-f ixed 
coordinates . 

To  begin,  the  expression  relating  the  acceleration  of  a  point 
relative  to  inertial  space  is  written  in  terms  of  accelerations  and 
velocities  relative  to  the  computer  axes  and  the  inertial  angular  rate, 


+  oj £  x  (u>£X  R)  (198) 


Equation  198  results  from  a  theorem  by  Coriolis.  It  describes  the  ideal 
behavior  of  the  computed  value  of  R  when  a  perfect  indication  of 
(d2  R/dt2)i  is  provided.  The  subscripts  C  and  I  indicate  the  coordinate 
frames  in  which  the  differentiation  takes  place  or,  in  the  case  of  the 
vector  u)£,  designate  the  coordinate  frame  under  consideration.  The 
vector  quantities  in  Eq.  198  can  be  resolved  into  any  coordinate  frame 
desired.  The  computer,  in  the  absence  of  information  about  system 
errors,  assumes  that  all  three  axis  systems  are  parallel.  It  will  solve 
the  equation  in  C  coordinates  and  the  solution  will  be  in  error  if 
specific  force  is  not  properly  indicated  and  resolved.  Improper  indi¬ 
cation  results  from  accelerometer  errors,  and  improper  resolution  results 
from  misalignment  between  the  computer  and  platform  axis  systems.  The 
indicated  specific  force  is  related  to  the  actual  value  in  the  computer 
coordinate  frame  by  - 


f.  “f-lf/xf+mV  (199) 

In  addition,  in  order  to  obtain  (d2*R/dt2)j,  the  mass  attraction  acceler¬ 
ation  mast  be  added  to  the  accelerometer  outputs  according  to  Eq .  42. 
Because  the  near-earth  navigation  coordinate  systems  outlined  previously 
all  indicate  local  vertical,  it  will  be  more  convenient  to  work  in  terms 
of  the  gravity  vector,  g", 


g  =  0  -  I!  x  (Q  x  R) 


(200) 


However,  for  the  purpose  of  investigating  the  efreote  of  saalJ.  errors 
in  the  computet!  value^  of  R  on  the  navigation  error  propagation,  g"  ran  be 
assumed  parallel  to  K  and  obeying 

g  “  -o)^  R  (201) 

~  uhe re 


When  JTJ  is  the  radius  of  the  earth,  u%  is  the  Schuler  frequency.  Then 

6g”  =  -wJ  6r  -  2w  (6iu  )  IT  (203) 

8  8  8 

and  the  perturbations  In  the  left  side  of  Eq .  198  caused  by  i iaalignment 
between  platform  and  computer  axes  and  email  errors  in  the  computed 
value  of  R  are,  to  the  first  order, 


-if'  x  +  V  +■  0  x  (fi  x  5R)  -  w?  6R  -  2c;  (6w  ) 

in  s  s  s 


Equating  these  to  the  first-order  perturbations  of  the  right  side  of 
Eq .  198  provides  an  expression  for  the  propagation  of  navigation  system 
errors 


t  x  -  *  V 


-2  -*(««>  &  • 
8  9 


(204) 


The  notation  of  Eq.  204  can  be  simplified  by  noting  that  rhe  first  four 
terms  on  tha  left  can  be  related  through  the  Theorem  of  Coriolis 
(Eq.  198)  to  similar  products  and  derivatives  as  viewed  from  the  true 
(unsubscripted)  axes 
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Replacing  the  absolute  value  notations  for  [  *t j  and  |gj  by  K  sad  g,  the 

quantity  4t»  can  be  further  refined  by  noting  that ,  from  ito  definition, 
8 


a  in 


h  h3 

&o  o 
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(206) 


Then 


g  •** 
°u  o 
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(207) 


Equation  205  becomes 
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Equation  208  can  be  ubfcd  to  demonstrate  the  fact  that,  If  the  navi¬ 
gation  equations  are  solved  along  a  coordinate  axis  which  is  not  orthogonal 
to  1?,  the  navigation  errot  along  this  axis  is  described  by  an  unstable 
differential  equation.  Of  course,  not  all  navigation  system  axes  can  be 
orthogonal  to  1  and,  in  fact,  near-earth  navigation  coordinate  systems 
usually  have  one  axis  parallel  to  .the  position  vector.  Many  of  the  terms 
in  Eq.  208  which  are  dependent  on  d)  and  Q  can  be  neglected  when  consider¬ 
ing  vehicles  traveling  near  the  earth's  surface  at  reasonable  speeds. 
Rearranging  and  simplifying,  Eq.  208  can  be  writ  Let 


6R  +  w4  (5R  -  3 16RI  )  =  -  $  x  L  +  v  .  2  £  *  el ; 
§  R  m 


(209) 
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lit  tli*-  ru>r  Ui=  vert  1  na  1  enord  inato'3  the  vector  R  i  3  essentially  poLaj,lol 
to  the  ?  axis.  In  that  cae*5  the  term 
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provide©  no  component  In  the  north  and  east  directions.  The  x  and  y 
components  of  &j .  209  are 


dR  *  yj'1  6H 
x  s  x 
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OR  +  uS3  6 R  = 
y  s  y 


2(uj6H  -  ui  6R  ) 
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(211) 


Tiie  unforced  portions  of  these  equations  exhibit,  a  pure  oscillatory 
characteristic  at  the  Schuler  Frequency.  liouev*  r,  along  the  axis  which  Is 
Is  not  essentially  orthogonal  to  K,  the  quantity  -3  |6R|  R/R  provides  a 
component  of  tuangitude 
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trtiere 


the  r  component  of  Eq.  209  i.3 


«R  +  w2  (1  -  3X)  6R  - 
z  s  z 


Ignoring  the  time-varying  nature  of  ((6RX)2  +  (SRy)2),  the  unforced 
portion  of  Eq.  212  is  unstable;  the  error  in  indicating  the  z  component 
of  R  will  grow  unbounded.  Similar  behavior  would  result  for  errors  in 
the  x  and  y  directions  if  they  were  defined  with  components  parallel  to 
R.  Of  course,  this  behavior  does  not  result  from  a  peculiar  charucter- 
stlc  R,  but  rather  from  the  need  to  compensate  accelerometer  outputs 
for  mass  attraction  forces  and  the  fact  that  ft  and  gravity  are  approxi¬ 
mately  parallel.  Because  the  mass  attraction  forces  obey  an  inverse- 
square  distance  law  and  must  be  calculated  according  to  the  indicated 
distance  from  the  earth's  center,  the  instability  results.  7’his  can  be 
seen  more  simply  by  considering  a  scheme  to  navigate  in  tfu  .ertical 
direction  only.  Figure  45  illustrates  the  calculations  necessary.  The 

n m  an  H  Mr 
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*comp 
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is  added  to  ehe  accelerometer  output  to  give  the  upward  acceleration  with 
respect  to  inertial  space.  Double  integration  gives  the  computed  value 
of  distance  to  the  center  of  the  earth,  R.  A  small  error  in  the  indicated 
value  of  R,  6R,  causing  it  to  be  too  large,  will  reduce  the  size  of  gcomp, 
making  the  indicated  value  of  acceleration  too  large.  The  integrations 
cause  the  indicated  value  of  R  to  grow  even  larger,  etc.  The  fact  that 
the  error,  6R,  grows  unbounded  i9  evident. 

The  implication  of  this  instability  for  practical  navigation  is  that, 
at  least  for  long  periods,  inertial  navigation  along  axes  not  perpendicular 
to  the  mass  attraction  force  is  not  feasible.  Over  short  periods  of  time 
such  as  that  encountered  for  a  missile  launch  the  error  growth  may  not  be 
significant.  However,  cruise  navigators  usually  instrument  only  horizontal 
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axes  end  use  altimeters  or  depth  gages  to  indicate  vertical  distance. 
When  vertical  motion  has  high- frequency  characteristics  or  must  be 
indicated  very  accurately,  a  vertical  accelerometer  may  be  used,  but 
assn  attraction  forces  are  co^uced  froa  height  indications  given  by 
other  instruments. 


Returning  to  Eq.  210  and  211,  for  near-earth  navigation  in  north- 
vertical  or  free  azimuth  coordinates  the  x  and  y  components  of  are 
given  by^  _  _  __  _ _  _ 


(213) 


In  addition,  for  the  north-vertical  system 


56 
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tan  L 


(214) 


(215) 


because  the  platform  axes  are  rotated  about  the  z  axis  according  to  y 
velocity.  The  tangent  Plane  navigation  coordinate  system  does  not 
exhibit  a  misalignment  o$  baaed  on  position  errors,,  because  no  axis 
system  rotation  results  from  position  changes.  The  same  is  true  of  50? 
in  the  free  azimuth  system.  For  the  two  locally  level  navigation  frames, 
Eq.  213  and  214  are  useful.  Since,  from  Eq ,  197, 


<j>  «■  +  60  (216) 


Furthermore,  for  near-earth  cruise  vehicles 


£*/ffl  4  V 
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From  Eq.  210,  211,  217,  213,  and  219,  the  differential  equations  for  x 
and  y  position  errors  in  near-earth,  locally  level  cruise  Inertial 
navigators  can  be  written 


0RX  *  g*y  ♦  *  2wz  8Ry  (220) 

fiRy  =  -  S«PX  -  v2ax  + vy  -  2wz6Rx  (?2l> 


To  completely  describe  the  error  dynamics  of  inertial  navigation 
systems  the  attitude  error  behavior  must  also  be  specified  analytically. 
To  begin,  two  relations  between  thn_  inertial  angular  rotes  of  the  plat¬ 
form  and  computer  coordinates  and  1 1>  are  stated 


*  4*  *  uc+  *  (222) 


and 


♦  =«p-  “>c  (223) 

Combining  Eq.  222  and  223  and  approximating  u  by  ~U, 

w 


£,  -  X  oJ  •*  £ 


(224) 
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This  Is  the  basic  equation  describing  the^error  angle  dynamics. 
Expressions  result  for  the  compr^nts  <?i  4‘ 

#x  s  ‘x  +  WI  *y  ■  “V  $z 


m  —  i  +  iff  Li  •  w  8 

7  y  *  z  z 


*s  s  *a  +  u'y  **  '  ^  *S 


(227) 


Using  the  x  component  of  Eq.  197,  213,  and  225 


ifi  *  4  t  66 

*  X  *  6R 

*  <  “  UJ  4)  ♦  u)  (u3  *  66  )  * 

x  j  *z  z  ,vy  y  It 


6R*  6Hy 

“V  ”*  +  “'z  *y  *  wz  TT  +  R 


In  a  like  manner. 


»R  6R 

"  TT 


(|)  E  (  -  4)  <0  +(*>(/)  -*  4a)  “  Lt)  -t —  4-  ftft 

*  i  “*  ■  y  y  vx  y  P.  x  Tt  0 


Equations  220,  221,  228,  229,  and  230  are  the  primary  error  dynamic 
equations  for  near-earth  inertial  (systems  of  the  locally  level  type  or 
for  a  tangent  plane  system  that  is  near  its  initial  point.  The  term 
69z  on  the  right  side  of  Eq.  230  is 


-tan  L  -g2-  +  w  sec*  L 
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when  a  north-vertical  eye  ten  is  being  considered  and  Ln  zero  for  tangent 
plane  and  free  azimuth  coordinates.  Usually,  terms  of  the  nature 


hi 


&k 


and 


2u  6R 


are  relatively  small  and  can  be  dropped.  The  three  near-earth  systems 
described  in  the  section  on  inertial  navigation  systems  differ  only  in 
the  way  they  provide  u>.  In  terms  of  latitude,  L,  and  longitude.  A, 
they  are 

1.  North-Vertical  System 


«  -  (A  +  ft)  cos  L 
x 


hi  “  -L 

y 


*  -(A'  r  ft)  sin  i 


2,  Free  Azimuth  System 


to  *  (A  +  ft)  cos  L  cos  a  -  L  sin  a 
x 


w  “  -(A  +  ft)  cos  L  sin  a  -  L  cos  a 

y 


(231) 


(232) 


U)  “  0 

z 


)  I 


3.  Tangent  Plane  System 


hi  ■  ft  COS  L 
X  o 

(o  «  0 

y 

to  -  -ft  sin  L 
z  o 


(233) 
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where  a  is  the  angle  between  north  horizontal  and  the  free  aziauth 
%  axis,  ft ad  L  is  the  initial  point  latitude. 


SUOiff-TESi  i&fiOR  PROPAGATION 

The  behavior  of  inertial  navigation  ayst os  errors  over  a  short 
period  <2  or  3  hours)  can  be  exhibited  by  considering  Eq.  220,  221, 

2?i,  229  and  23G.  It  will  be  recalled  that  they  describe  the  behavior  -  — 
of  local lv -  love  1  near-earth  eysteas.  The  «a}or  terss  in  these  eqrieticns 
are  used  to  produce  the  block  diagrams  for  the  a  and  y  loops  shown  in 
Fig.  46.  While  the  two  information  loops  generated  are  interconnected 
through  the  quantity  u*2,  the  princioal  short-period  dynasties  result  froa 
the  feedback  paths  shown.  The  unforced  short-period  behavior  can  be 
obtained  in  Laplace  Transfora  notation  by  Inspection  of  fig.  46. 

(e-  +  g/R)  4-0  (234) 

X 

(a2  +  g/R)  4y  -  0  (235) 

The  unforced  dynamics  consist  of  undamped  osclllatlono  at  the  Schuler 
frequency  (84-mir  period).  The  effects  of  sensor  errors  on  position, 
velocity,  and  attitude  errors  follow  froa  the  equations 


(236) 

(237) 

(238) 


(239) 


provide  growing  position  errors  and  oscillating  velocity  errors.  Constant 
gyro  drift  rate  generates  an  oscillating  attitude  error. 
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LO^JG-TERK  ERROR  PROPAGATION 


In  aorth-ver Lieal  inertial  navigation  ayi-tew? ,  error  dynamics  of  « 
fre^ueacy  considerably  lower  Urea  those  described  above  occur.  Essen¬ 
tially.  ***»##«  addicleeal  dynamites  result  fr t®  uncertainty  in  the  ce»- 
juiter's  kaavlonge  of  the  orientation  of  the  earth  rotation  wefor,  .Q. 

If  it  is  »a  ft  limed  that  die  navigator  is  not  moving  '-‘ith  respect  to 
the  4M«b,  -  — -  -  - 


6*6  -  -6L 

y 

•  • 

68  -  -Oa  sin  L 

z 


(2*0) 

(241) 

(242) 

(243) 

(244) 


From  Eq.  197f  225.  226,  227,  and  241  and  the  above  expressions ,  differ¬ 
ential  equatione  result  for  the  components  of  $, 
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Terms  which  do  not  provide  closed  information  loops  hay?  been  omitted 
trotn  these  equations.  Notice  that  the  use  of  Eq.  241  has  eliminated  61 
frois  consiuetsiicm.  Finally,  Eq .  220  and  221  provide 


and 


6R 

T'  “  I  ®y 


-JL 

K 


(249) 


Equations  2*0  and  245  through  249  can  be  written  in  terms  of  Laplace 
Transforms  and  arranged  in  the  vector-matrix  form 


1 

0 

0 

0 

0 

*■ 

“S 

6R  * 

X 

R 

0 

•1 

s 

ft  sin  L 

0 

ft  sin  L 

6R 

_JSL 

R 

1 

0 

-Q  sin  L 

s 

-ft  cos  L 

0 

*y. 

0 

tan  L 

0 

ft  con  L 

s 

ft  cos  L 

<b 

y 

s 

0 

0 

_  £ 

R 

0 

0 

*■ 

0 

. 

s 

£ 

R 

0 

0 

0 

fiw 

U 

(250) 


Ey  setting  the  determinant  of  the  coefficient  matri::  in  Eq .  250  to  zero, 
the  behavior  of  the  variables  can  be  seen 


(S2  +  |)  (S2  +  ft2)  =  0 


(251) 
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-  i 


The  two  Schicler  frequency  charaetei  is  tics  result  from  the  x  and  v  loop 
Short-period  error  behavior.  The  additions.!  oscillation  is  3  24- hour 
or  long-pei'i.-jcl  mode  which  is  nor  important  when  durations  of  2  or  3  hours 
are  considered*  but  ie  significant  in  long-term  cruise  navigators. 

Kaey  ciosa-uaupling  terms  have  Ignored  both  in  this  discussion 

4ftd  the  one  preceding.  Their  effects  are  usually  secondary  compared  to 
those  displayed  here.  Consideration  of  a  vehicle  moving  over  the  earth's 
surface  ^ould  U*v~  «*4i F ied  -the  24-hour  mode,  hut  for  most  applications 
the  fijJUi  of  X  la  ouch  less  titan  52.  When  the  acceleration  compensation 
error  terms  (of  the  nature  2u)  $R)  are  retained  in  £q.  220  and  221,  the 
aasrt-Cera  oscillation  frequencies  are  modified  slightly.  A  more 
detailed  analysis  is  presented  in  Ref.  41.  Figure  4?  shews  the  reeult 
of  a  simulation  la  which  the  errors  In  a  stationary  north-vertical 
system  were  excited  by  a  constant  x-axia  gyro  drift  rate,  rhe  B4-minute 
mode  is  clearly  visible.  In  addition,  the  first  quarter  of  a  24-hour 
mode  is  evident. 

The  error  equations  developed  in  this  Appendix  are  further 
specialised  to  provide  syrtera  behavior  matrices,  F,  for  the  several 
navigation  schemes  considered  in  Section  5. 


| 

I 

M  l 


I 

r 


I 


i 

I 


1 


I 


200 


-100 


60  “  120  181 


Time  ( Minutes) 

FIG.  47.  Platform  Tilt  Errors  Rasul 
North  Axis  Gyro  Drift  Rate. 


r/VC  TP  4tii)2 


From  Constant 


REFERENCES 


1.  Derusso,  Paul  M. ,  Rob  J.  Ray,  and  Charles  K.  Close.  State 
Variables  for  Engineers.  John  Wiley  6  Sons,  Inc.,  New  York,  1965. 

2.  IBM  Corporation.  Synergistic  Navigation  System  Study,  by  Kenneth  — 
A.  Klementis,  et  al.  Owego,  N.  Y.,  October  1966.  Report 

No  67-928-7. 

3.  The  Analytic  Sciences  Corporation.  Error  Analysis  of  a  Strapdowr 
Aided  Aircraft  Inertial  Navigation  System,  by  Arthur  Gelb  and 
Stephen  A.  Levine.  Winchester,  Maes.,  October  1966,  Technical 
Report  110-2. 

4.  Wiener,  Norbert.  The  Extrapolation,  Interpolation  and  Smoothing 
of  Stationary  Times  Series.  John  Wiley  S  Sor.s ,  Inc.,  New  York, 

1949. 

5.  Kalman,  R.  E. ,  and  R.  S.  Bucy.  New  Results  in  Linear  Filtering 
and  Prediction  Theorv.  ASME,  TRANS  (Journal  of  Basic  Engineering), 
Vol.  8 3D,  March  196;  vp.  95-108. 

6.  Bryson,  A.  E, ,  and  '.  Johansen.  Linec-r  Filtering  for  Time- 
Varying  Svstems  Using  Measurements  Containing  Colored  Noise.  IEEE 
TRANS  on  Automatic  Control,  Vol.  AC-10,  January  1961.  pp  4-10. 

7.  Research  Institute  for  Advanced  Studies.  New  Methods  and  Results 
in  Linear  Prediction  and  Filtering  Theory,  by  R.  E.  Kalman. 
Baltimore,  Maryland,  1961.  (Technical  Report  61-1.) 

8.  Athans,  M.  ,  and  P.  L.  Falb.  Optimal  Control.  McGraw-HilJ  Book  Co,, 
New  York,  1966. 

9.  Kalman,  R.  L.  A  New  Approach  t.o  Liuear  Filtering  and  Prediction 
Problems.  ASME,  TRANS  (Journal  of  Basic  Engineering),  Vol.  82D, 
March  1960,  pp.  35-45. 

10.  Bryson,  Arthur  E. ,  Jr.,  and  Yu-Chi  Ho.  Optimum  Pirogrsrming , 
Estimation  and  Control  (in  process). 

11.  Denham,  Walter  F.,  and  Jason  L.  Speyer.  Optimal  Measurement  and 
Velocity  Correction  Programs  for  Kidcourse  Guidance.  AIAA  J, 

Vol  2,  No.  5,  May  196a,  pp.  896-907. 

12.  Sutherland,  Arthur  A.  ,  Jr.  Application  of  Optimal  Linear 
Estimation  to  the  Alignment  of  Inertial  Guidance  Systems.  Sc.D. 
Thesis,  M.T.T.  Department  of  Aeronautics  and  Astronautics, 

September  1966. 


| 


i 

| 

i 


146 


..TTiii^n„4.i<(j)ituiiiJUiiuniiM.filiuuiJU)lUlillIIUlBilJLUIiill>  uUiiiUlli^odUUillfllUIJiiJiJi-  ilil»ndj.liiiil>ii<t-UHi  Mi". 


13.  Raytheon  Company.  Smoothing  for  Linear  and  Non-Linear  Dynaaie 

Systems,  by  Malcolm  Frazier  and  Arthur  E.  Bryson,  Jr.  Lexington, 
Mass.,  October  1962.  (BR-2033) . 

14.  Harvard  University,  Cruft  Laboratory.  Identification  of  Linear 
Dynamic  Systems,  by  Yu-Chi  Ho  and  Robert  C.  K.  Lae.  Cambridge, 
Maas.,  May  1964.  (Technical  Report  No.  446). 

15.  Stanford  Research  Institute.  Research  on  the  Design  of  Adaptive 
Control  Systems,  by  J.  Peschon,  at  al.  Menlo  Park,  Calif., 

September  1966.  (NASA  CR  81731). 

16.  Detil.am,  W.  F.  ,  and  Samuel  Pines.  Sequential  Estimation  When 
Measurement  Function  Non-Linearity  is  Comparable  to  Measurement 
Error.  AIAA/ION,  PROC  Guidance  and  Control  Conference,  August  1965, 
pp.  174-180. 

17.  Harder,  D.  and  J.  E.  Connor.  Study  ox  Filter  Techniques  in  Distant 
Planet  Satellite  Orbit  Parameter  Estimation.  AIAA/JACC,  PROC, 
Guidance  and  Control  Conference,  August  1966,  pp.  534-543. 

18.  Neal,  S.  R.  Non-Linear  Estimation  Techniques.  July  1967 
(in  process) . 

19.  Grumman  Aircraft  Engineering  Corporation,  Research  Department. 

The  Effect  of  Linearity  Assumptions  and  Unknown  Noise  Source"  on 
Kalman  Filtering  in  Orbit  Determination,  by  W.  O'Dwyer, 

J.  Mendelsohn,  and  A.  Kaercher.  Bethpaae,  N.  Y.,  GAEC-Rn, 

May  1967.  (Report  RE-2851.) 

20.  Diaper,  Charles  S.,  Walter  Wrigley,  and  John  Hovorka.  Inertial 
Guidance.  Pergamon  Press,  New  York,  1960. 

21.  Gelb,  A.  Synthesis  of  a  Very  Accurate  Inertial  Navigation  System. 
IEEE  TRANS.  Aerospace  and  Navigational  Electronics,  Vol.  12, 

June  1965,  pp.  119-128. 

22.  Bryson,  A.  E.,  Jr.,  and  L.  J.  Henriks on.  Estimation  Using  Samp/ed- 
Data  Sequentially  Correlated  Noise.  AIAA,  PROC,  Guidance,  Control 
and  Flight  Dynamics  Conference  (Astrodynamics) ,  August  1967, 

Paper  No.  67-5^1. 

23.  Fitzgerald,  Robert  J.  Filtering  Horizon — Sensor  Measurements  for 
Orbital  Navigation.  AIAA/JACC,  PROC,  Guidance  and  Control 
Conference,  August  1966,  pp.  500-509. 


147 


IitoatUiittllliaiTSIimHI  HMSSHHmfflBin  iK3Mai».,tnJnn“  ni'tritmja.miBii  mi|Hmuiaru|.TO»< 


24.  Wilcox,  James  C.  Self-Contained  Orbital  Navigation  Systems  with 
Correlated  Measurement  Errors.  AIAA/IQN,  PROC,  Guidance  and 
Control  Conference,  August  1965,  pp.  231-247. 

25.  Dushman,  Alan.  On  Gyro  Drift  Models  and  Their  Evaluation.  IRE, 
TRANS,  Aerospace  and  Navigational  Electronics,  Vol.  ANE-9,  No.  4, 
December  1962, 

26.  _ Collins  Radio  Company.  An  Accuracy  Study  of  a  Doppler  Navigation 

System  Assuming  Time  Stationary  Random  Input  Errors,  by  James  C. 
Styers.  Cedar  Rapids,  Iowa,  May  1961.  Report  No.  CER-1396. 

27.  Bona,  B.  2. ,  and  Robert  J.  Smay  Optimum  Reset  of  Ships  Inertial 
Navigation  System.  IEEE,  TRANS,  Aerospace  and  Electronic  Systems, 
Vol.  AES-2,  No.  4,  July  1966,  pp.  409-414. 

28.  Sandberg,  Herbert  J.,  Arthur  Gelt,  and  Alan,  L.  Friedman. 

Alignment  of  Inertial  Navigators  in  Low-Speed  Vehicles.  AIAA  J, 

Vol.  1,  No.  9,  Sept.  1963,  pp.  2030-2034, 

% 

29.  Fagin,  S-  L. ,  E.  Jrinocn,  and  A.  Gracfe.  Continuous  Time  Varying 
Optimal  Feedback  Applied  to  the  Augmentation  and  Rapid  Alignment 
of  Inertial  Systems.  Supplement  to  the  IEEE,  TRANS,  Aerospace 
and  Electronic  Syetems,  Vol.  AES-2,  No.  4,  July  1966,  pp.  661-67C. 

30.  Lipton,  Arthur  H.  Alignment  of  Inertial  Systems  on  a  Moving  Ease. 
Sc.D.  Thesis,  M.I.T.  Department  of  Aeronautics  and  Astronautics, 
August  1966. 

31.  Pitman,  George  R. ,  Jr,,  Editor.  Inertial  Guidance.  John  Wiley 
and  Sons ,  T.nc. ,  New  York  1962. 

32.  Auburn  Research  Foundation,  Avburn  University,  An  Introduction  to 

Analytic  Platforms  for  Inertial  Guidance,  by  J.  T.  Lowry.  Auburn, 
Ala.,  ARF(A) ,  April  1966.  (NASA-CR-75074.) 

33.  Massachusetts  Institute  of  Technology,  Electronic  Systems  Laboratory 
Augaentsd  Inertial  Navigation  Systems,  by  Donald  R.  Knudson. 
Cambridge,  Mass.,  April  1966.  (Report  ESI -R-264.) 

34.  Martin-Mrrietta  Corporaii o:  .  A  U.yer’s  Manual  for  the  Automatic 
Synthesis  Program  (Program  C) ,  by  R.  2.  Kalman  and  S.  Englar. 
Baltimore,  Md.,  June  1966.  (NASA  CR-475.) 

35.  Bellantoni,  J.  J. ,  and  K.  W.  Dodfte.  A  Square  Hoot  Formulation  of 
the  Kalman- Schmidt  Filter,  AIAA  Paper  No.  67-90,  AIAA  5th  Aerospace 
Sciences  Meeting,  New  York,  January  1967. 


148 


NWC  TP  4652 


36.  Joseph,  P.  D.  Automatic  Kendevous,  Part  ;I:  On  Board  Navigation 
for  Rer.devous  Missions,  Course  Notes  for  Space  Control  Systems  - 

At ti rude,  Pendeveua ,  and  Docking,  UCLA  engineering  Extension,  1964. 

37.  Bona,  B.  E.  ,  and  C.  E.  Hutchinson.  An  Optimum  Stellar-Inertial 
Navigation  System,  Journal  of  the  Institute  of  Navigation,  Vol.  12, 
No.  2,  Summer  1965,  pp.  171-178. 

38.  Larson,  R.  E. ,  R.  M.  Dressier,  and  R.  S.  Ratner.  Precomputation 
of  the  Weighing  Matrix  in  an  Extended  Kalman  Filter.  Joint  Auto¬ 
matic  Control  Conference,  University  of  Pennsylvania,  June  1967. 

39.  Pentecost,  Eugene  E. ,  and  Allen  R.  Stubbcrud.  Synthesis  of  Compu¬ 
tationally  Efficient  Sequential  Linear  Estimators,  IEEE,  TRANS, 
Aerospace  and  Electronic  Systems,  Vol.  AES-3,  No.  2,  March  1967, 
pp.  242-249. 

40.  Nishimura,  T.  Error  Bounds  of  Continuous  Kalman  Filters  and  the 
Application  to  Orbit  Determination  Problems,  IEEE,  TRANS,  Automatic 
Control,  Vol.  AC-12,  June  1967,  pp.  268-275. 

41.  Broxmeyer,  Charles.  Inertial  Navigation  Systems.  McGraw-Hill  Book 
Co.,  New  York,  1964. 


149 


BIBLIOGRAPHY 


1.  Brock ,  Larry  D.  Application  of  Statistical  Estimation  of  Navigation 
Systems,  Ph.D.  Thesis,  M.I.T.  Department  of  Aeronautics  and 
Astronautics,  June  1965. 

2.  Carson ,  R=  C.  Investigation  of  the  Suitability  of  Kalman  Optimal 
Filter  Theory  for  Improving  the  Performance  of  Aircraft  Type  Self- 
Contained  Navigation  Systems.  U.S.  Naval  Air  Development  Center, 
Johnaville,  Pa.,  November  1966.  (Report  No.  NADC- AM-6644 . ) 

3.  Fagin,  Samuel  L.  Feedback  Realization  of  a  Continuous  Time 
Optimal  Filter.  IEEE,  TRANS,  Aerospace  and  Electronic  Systems , 

Vol.  AES- 3,  May  1967,  pp.  494-509. 

4.  Fang,  Bernard  T.  Kalman-Bucy  Filter  for  Optimum  Radio-Inertial 
Navigation.  IEEE,  TRANS,  Automatic  Control,  Vol.  AC-12,  August  1967 
pp.  430-431. 

5.  Greens ite,  Arthur  L.  Analysis  and  Design  of  Space  Vehicle  Flight 

Control  Systems,  Vol.  VI --Stochastic  Effects.  General  Dynamics 
Corp.,  San  Diego,  Calif.,  July  1967.  (NASA-CR-825) . 

6.  Heffes,  H.  The  Effect  of  Erroneous  Models  on  the  Kalman  Filter 
Response,  IEEE,  TRANS,  AuCOLatic  Control,  Vol.  AC-11,  July  1966, 
pp.  541-543. 

7.  Huddle,  J.  R.  On  Suboptimal  Linear  Filter  Design,  correspondence 

in  IEEE  TRANS.  Automatic  Control,  Vnl ,  AC-12,  June  1967,  pp.  317-313 

8.  Kwakeinaak,  H.  Optimal  Filtering  in  Linear  Systems  with  Tinvi  Delays 
IEEE,  TRANS,  Automatic  Control,  Vol.  AC-12,  April  1967,  pp.  169-173. 

9.  Hacomber,  George  R. y  and  Manuel  Fernandez.  Inertial  Guidance 
Engineering.  Prentice-Hall,  Inc.,- 1962. 

10.  Nishlsura,  T.  On  The  A  Priori  Information  in  Sequential  Estimation 
Problems.  IEEE,  TRAMS,  Automatic  Control,  Vol.  AC-11,  April  1966, 
pp.  197-204. 

11.  Pinson,  John  C.  “Inertial  Cuidance  for  Cruise  Vehicles,"  Chapter  4 
of  Guidance  and  Control  of  Aerospace  Vehicles,  ed.  by  C.  J.  Leondes. 
McGraw-Hill  Book  Co. ,  Inc. ,  New  York,  1963. 

12.  Rlchman,  Jack,  and  Bernard  Frledland.  Design  of  Optimum  Mixer- 
Filter  for  Aircraft  Navigation  System.  Proceedings  of  the  19th 
National  Aerospace  Electronics  Conference,  May  1967,  pp.  429-438. 


'^inilp'finjtuPjjr-nfr  .Jjrti  l  .j  >rtrpi  irptn’i-'T 


13.  Schles,  F.  H. ,  C.  J.  Standlsh,  and  H.  F.  Tgda,  Divergence  in  the 
Kalraan  Filter.  AIAA  J,  Vol.  5,  June  1967,  pp.  1114-1120. 


UNCLASSIFIED 


-." •  SertintY  t  UmMltcutmn  _ 


DOCUMENT  CONTROL  DATA  -  R  &  0 

5<*«'unr«*  i7mi  »tftr Hi  ion  ot  title,  f*nly  %»f  ,th*9  r»tt  t  and  indettitig*  ,mnotntit»n  m«»>f  he  entered  when  Wn*  >>%'*-r,»ll  report  r  .  «  I.ivmIii'i/i 


t  0*<i0iN*TINC  ACTIVITY  ft’orprtf*#*  MO  tit  or  > 

The  Analytic  Sciences  Corporation 


I  za.  ntroHT  S  i:  c  u  r<  t  '  V  c  l  a  ■:  m  i  it  ahou 


Unclassifed 


I?/).  CHOUP 


6  Jacob  Way 
Reading,  Mass. 


•  REPORT  TITLE 

APPLICATION  OF  THE  KALMAN  FILTER  TO  AIDED  INERTIAL  SYSTEMS 


*  DESCRIPTIVE  NOTES  (Type  of  report  and  Inclusive  dares) 

Final  Report 


5  author^)  (ftrirnsm*,  middle  tnitial.  last  name) 

Sutherland,  Arthur  A. ,  Jr. 
Gelb,  Arthur 


«  REPORT  OATK 

August  1968 


•a.  contract  o«  GRANT  NO. 

N60530-67-C-1052 

ft.  PROJECT  NO. 


7«,  TOTAL  no  OF  PAGES  1 7b.  NO  OF  REFS 


9a.  ORIGINATOR'S  REPORT  NUMBERlS) 


NWC  TP  4652 


90.  OTHER  REPORT  nOISI  (Any  other  numbers  that  may  be  aari&ned 
thin  report) 


10.  distribution  statement. 

THIS  DOCUMENT  IS  SUBJECT  TO  SPECIAL  EXPORT  CONTROLS  AND  EACH  TRANSMITTAL  TO  FOREIGN 
GOVERNMENTS  OR  FOREIGN  NATIONALS  MAY  BE  MADE  ONLY  WITH  PRIOR  APPROVAL  OF  THE  NAVAL 
WEAPON!  CENTER. 


12-  SPONSORING  MILITARY  A  C  T  I  V  I  T  > 


Naval  Weapons  Center 

China  Lake,  California  93555 


13.  .IITH«CT 


~"5>  The  purpose  of  this  tutorial  report  is  to  allow  the  reader  with  a  limited 
background  in  optimum  estimation  techniques  and/or  inertial  system  theory  to 
achieve  a  level  of  competence  which  will  permit  his  participation  in  the  design 
and  evaluation  of  aided  inertial  guidance  systems.  To  this  end,  the  Kalman 
Filter  is  described  in  some  detail,  with  full  use  made  of  intuitive  concepts. 

Next,  the  theory  of  inertial  n^j^Uat^on  is  presented.  iJased  on  an  understanding 
of  inertial  systems  and  the  Kalman  Filter,  the  reader  is  then  shown  how  the  two 
are  combined  to  provide  accurate,  aided  inertial  systems.  'Problems  arising  in 
the  application  of  the  Kalman  filter  to  practical  situations  are  discussed  ar.d 
common  methods  for  solving  them  are  illustrated.  Examples  in  inertial  navigation, 
gyrocompass ing,  and  alignment  transfer  are  provided  in  support  of  the  theoretical 
development. 


DD  F.r.,1473 


IP AGC  ! ) 


UNCLASSIFIED 


Security  Classification 


UN&AS&ipm 


SecufUy  CI»«tificiUon 


k ev  wo«o 


Aided  Inertial  navigation 
Kalman  Filter 


00 


FO** 


,1473 


( HACK  ) 


i  hc  v  a 


AUr  Z5~/ 


DEPARTMENT  OF  THE  NAVY 
NAVAL  WEAPONS  CENTER 


Cmima  u«,  CAurotwn 

93555 


tH  *»tPLY  Utrt"  TO 


CHINA  LAKE  AND  CONONA  LA90AAT0AILS 


751/GCA: ga 
6  June  1969 


Fr *■"  : :  Commander,  Naval  Weapons  Center 
To:  Distribution  List  of  NWC  TP  4652 


SubJ:  NWC  TP  4652,  Application  of  the  Kalman  Filter  to  Aided  Inertial 
Systems,  dated  August  1968;  errata  for 


Enel:  Replacements  for  Equations  159,  164,  and  168 


1*  It  is  requested  that  the  corrections  shown  below  be  incorporated  in 
NWC  TP  4652.  The  corrections  have  been  printed  on  gummed  stock  so  that 
they  may  be  pasted  in  place. 


Page  116:  Replace  Equation  159  with  new  equation 
Page  117:  Replace  Equation  164  with  new  equation 
Page  118:  Replace  Equation  168  with  new  equation 


C.  E.  VAN  HA0AN 
By  direct 10^7 


KWC  TP  4652 


ERRATA 


Page  116,  Eq.  159  should  read: 
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Page  117,  Eq.  164  should  read: 
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Page  118,  Eq.  168  should  read: 


i  -*.ri  v  +  Q. 

Vi  « 


V  i 


“  SjJ+l  HtH-l  P1  Mn+1  *n+l  *  *«♦!  M“+1  *\  ^  ^ 


1  - 


■i*)T 


V+L  irri  *Q  -  a  TT  T 

*  H»  Vt  •£,  *  %.  V.  <.  -1.  ■&  *  (’ '  *&•  “-■>  **«  '>=  ^  (168) 

*  (‘  -  Kn  ‘S«)  *S  *ST  (‘  '  ‘S*> 

,  »Li  «di  *  ♦. p 3  »:r  (*  -  ■*«  ^i)T  *  "•  ‘1*  *& 

n  n 


'Vi  •  ?1 


19  Hay  1969 


